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INTRODUCTION 


The  requirement  for  feedback  control  systems  in  underwater  vehicles 
is  well  established.  In  its  absolute  form,  feedback  systems  are  used  to 
control  vehicle  depth  and  yaw,  while  rate  feedback  (pitch  or  yaw  rate) 
can  be  used  to  improve  a vehicle's  handling  characteristics.  The  pur- 
pose of  this  report  is  to  present  a step-by-step  procedure  for  the  analy- 
sis of  vehicle  longitudinal  feedback  control  systems. 

The  control  system  discussed  is  general  in  that  it  allows  the 
designer  to  select  any  or  all  of  four  feedback  loops  (pitch  rate,  pitch, 
depth  rate,  and  depth).  Each  loop  is  analyzed  separately  for  this  pur- 
pose. The  root-locus  technique  is  used  in  the  analysis.  To  aid  the 
engineer  in  the  design  process,  a computer  program  has  been  written 
that  will  perform  all  the  necessary  computations.  This  program  is  suit- 
able for  analyzing  both  self-propelled  and  towed  vehicles . Inputs  to 
the  program  consists  of  vehicle  length,  speed,  mass,  moments  of  inertia, 
and  the  30  linear  hydrodynamic  coefficients.  Vehicle  mass  and  moments 
of  inertia  are  computed  using  the  MIDCOHV  computer  program  WTBAL  re- 
ported in  NCSL  Report  220-74'^.  The  hydrodynamic  coefficients  are  com- 
puted in  the  MIDCOHV  computer  program  GEORGE.  The  details  necessary 
for  running  the  program  are  presented  in  the  users  guide  section.  An 
example  design  is  Included  to  illustrate  the  analysis  of  a longitudinal 
feedback  control  system.  The  analysis  of  lateral  feedback  control  sys- 
tems is  discussed  in  an  NCSL  report 


^x^Naval  Coastal  Systems  Laboratory  Report  220-74,  The  MIDCOHV  Weight 
and  Balance  Computer  Program  (WTBAL) , by  K.  W.  Watkinson,  September 
1974,  Unclassified. 

^a*Naval  Coastal  Systems  Laboratory  Report,  The  Analysis  of  Lateral 
Control  Systems  for  Self-Propelled  and  Towed  Submarged  Vehicles, 
by  Douglas  E.  Humphreys,  Richard  W.  Miller,  and  Larry  F.  Dewberry, 
(in  publication),  Unclassified 
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LONGITUDINAL  CONTROL  SYSTEM  ANALYSIS 


BACKGROUND 

A general  model  of  a longitudinal  feedback  system  is  shown  in 
Figure  1.  The  feedback  loops  are  pitch  rate  (9),  pitch  angle  (9), 
depth  rate  (Z) , and  depth  (Z) . The  sensors  are  modeled  as  pure  gains 
and  are  denoted  as  Kg,  Kg,  K£,  and  Kg.  There  are  two  command  inputs: 
desired  depth  (Z0)  and  desired  pitch  angle  (60). 

The  purpose  of  a feedback  control  system  is  to  either  stabilize 
an  unstable  system,  improve  the  system  response  characteristics,  to  con- 
trol a certain  variable,  such  as  depth,  or  a combination  of  these.  The 
desired  vehicle  control  is  achieved  by  successively  closing  each  loop 
and  varying  the  loop  gain  until  the  desired  system  dynamics  are 
acheived.  The  root- locus  method  is  used  here  to  aid  in  the  analysis 
process.  For  additional  details  on  the  root-locus  method  and  the  mathe- 
matics of  Laplace  transforms,  See  References  3,  4,  5,  and  6 and 
Appendix  A. 


FIRST  LOOP 


The  inner-most  loop  (or  first  loop)  is  shown  in  Figure  2.  The 
vehicle  transfer  function  relating  pitch  rate  response  to  stern  plane 
input  is 


9 

6 


s9 

6 

s 


(3>Clark,  R.  N. , Introduction  to  Automatic  Control  Systems,  John  Wiley 
and  Sons,  Inc.,  1973. 

^Hale,  F.  J.,  Introduction  to  Control  System  Analysis  and  Design, 
Prentice-Hall,  Inc. , 1973. 

^Blakelock,  J.  H. , Automatic  Control  of  Aircraft  and  Missiles , John 
Wiley  and  Sons,  Inc.,  1965. 

^ Hildebrand,  F.  B. , Advanced  Calculus  for  Applications,  Prentice- 
Hall,  Inc. , 1963. 


(Text  Continued  on  Page  4) 
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FIGURE  1.  BLOCK  DIAGRAM  FOR  LONGITUDINAL  CONTROL  SYSTEM 


0 

Where  * Pitch  angle/control  deflection  transfer  function 
s numerator 

D - Denominator  of  vehicle  transfer  function. 

The  numerator  and  denominator  are  functions  of  the  vehicle  hydrodynamic 
coefficients.  Appendix  B gives  the  expanded  form  of  each  of  the 
vehicle  transfer  functions. 

By  solving  for  the  closed  loop  transfer  function,  0/e^,  and  varying 
the  feedback  gain,  Kg,  the  system  dynamics  can  be  adjusted  to  yield  the 
desired  performance.  Solving  for  this  closed  loop  transfer  function 
yields 


sir 


sN, 


Q_ 

e. 


s 


sN* 


D - 


1 - 


K; 


sH6  Ke 

8 


For  stability:  Kg  0. 


Note  that  although  Figure  2 shows  the  feedback  signal  being  added  to 
the  input  signal,  the  system  is  actually  a negative  feedback  system 
since  the  numerator,  , will  always  carry  a negative  sign . 

a 
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Closing  the  first  loop  yields  a new  vehicle;  i.e.,  a rate  con- 
trolled vehicle,  with  a new  characteristic  equation 

D’  - D - sN l K'  . 
s 

The  single  prime  Indicates  a system  with  one  loop  closure. 


SECOND  LOOP 


Figure  3 shows  the  vehicle  second  loop  after  the  first  loop  has 
been  closed.  The  vehicle  transfer  function  with  one  loop  closed  is 
denoted  by  S/e-^.  The  vehicle  transfer  functions  with  two  loops  closed 
is 


9_ 

e2 


i / 0 

i/s- 

i+S-S 

ei s 


N, 


s 


D - 


Ke 

s 
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For  stability:  Kq  £ 0. 


FIGURE  3.  BLOCK  DIAGRAM  FOR  THE  SECOND  LOOP 
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Note  that  in  order  to  solve  for  the  above  transfer  function,  the  pitch 
angle  command  was  set  to  zero.  Since  the  commanded  pitch  angle  does 
not  affect  the  vehicle  characteristic  response,  this  requirement  in  no 
way  restricts  the  analysis  capability.  After  the  system  response  has 
been  evaluated  for  0O  ■ 0,  trajectories  for  other  pitch  angle  commands 
can  be  evaluated  using  time  domain  solutions  such  as  the  one  shown  in 
Reference  7. 


THIRD  LOOP 

Figure  A shows  the  block  diagram  of  the  third  loop.  The  vehicle 
transfer  function  with  two  loops  closed  is  denoted  by  0/e2»  To  form 
the  depth  rate  signal  (Z)  requires  the  combination  of  the  pitch  signal 
and  the  vertical  velocity  according  to  the  following  equation 

• 

z - w - u e , 

o * 
or 

Z/0  « w/0  - Uq. 

The  w/0  transfer  function  is  obtained  by  dividing  the  w/6g  transfer 
function  by  the  0/6g  transfer  function  which  yields 


w/6 

s 

0/6 

8 


W 

0 


N 


,w 


N 


,w 


N, 


Nj 


The  theoretical  basis  for  this  operation  can  be  found  in  an  NSRDC 
report 


(7)Naval  Ship  Research  and  Development  Center,  Report  No.  P-4-3-H-01, 
User's  Guide  NSRDC  Digital  Program  for  Simulating  Submarine  Motion 
ZZMN  Revision  1.0,  by  Ronald  W.  Richard,  June  1971,  Unclassified. 
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The  vehicle  transfer  function  with  three  loops  closed  is 


0 w 
^ - "o 


3 1 + ir2  f - v k; 


W 0 

N*  - N*  U 
0 6 o 

s s 


,e 


,w 


3 D - sNg  Kg  + K0N0  + (N" 

s " s 


N6  V 

8 


For  stability  ^ 0. 


Note  that  from  Figure  4 this  is  a positive  feedback  system.  This  con- 
vention was  chosen  to  conform  with  the  Navy's  standard  motion  simulation 
program  in  Hildebrand's  textbook^  . The  reader  should  note  the  dif- 
ference between  a negative  feedback  and  a positive  feedback  root  locus. 
In  a negative  feedback  system,  the  locus  of  roots  on  the  real  axis  lies 
to  the  left  of  an  odd  number  of  poles  or  zeros.  In  a positive  feedback 
system,  the  locus  of  roots  on  the  real  axis  lies  to  the  right  of  an  odd 
number  of  poles  or  zeros.  In  both  cases,  the  locus  emanates  from  a 
pole  and  terminates  at  a zero. 

• 

Also  note  from  Figure  4 that  the  value  for  K£  is  dimensionalized 
by  dividing  it  by  57.3  (=  4 arctan  1). 

FOURTH  LOOP 


Figure  5 shows  the  model  of  the  fourth  and  final  loop.  The  vehicle 
transfer  function  with  three  loops  closed  is  denoted  by  Z/e^.  The 
vehicle  transfer  function  with  four  loops  closed  is 


Z 

Z 


1^ 

s 


1 - 


K 


I 

Z e3  s 


Z 

z 


-Vn6  -n  V 

_8 8 

S[D  - sN®  K'  + KgN®  + K'  <H“  - N®  Uo>]  - Kz  W”  - N®  U,) 

S S S3  S S 


(6)ibid. 


(Text  Continued  on  Page  9) 
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FIGURE  4,  BLOCK  DIAGRAM  FOR  THE  THIRD  LOOP 


FIGURE  5.  BLOCK  DIAGRAM  FOR  THE  FOURTH  LOOP 
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For  stability:  Kg  _<  0 . 

Note  again  that  this  is  positive  feedback.  Again  notice  that  the  value 
of  Kg  is  dimensionalized  by  dividing  it  by  57.3. 

The  augmented  vehicle  response  is  achieved  by  the  commanded  deflec- 
tion of  the  stern  plane.  The  control  law  that  determines  the  stern 
plane  position  as  a function  of  time  is  seen  from  Figure  1 as 

• • 

6 - K1  0 - (0  - 9)  Ke  - K Z - (Z  - Z)  K„  . 

s 0 o 0 z o Z 

This  conforms  to  the  control  law  used  in  Reference  8. 


COMPUTER  PROGRAM  USERS  GUIDE 


BASIC  PROGRAM  DESCRIPTION 

This  program  computes  the  roots  of  the  numerator  and  denominator 
for  a submerged  vehicle  with  the  feedback  control  system  described  in 
the  previous  section  and  Appendix  C.  The  basic  inputs  to  the  program 
are  the  vehicle  nondimensional  hydrodynamic  coefficients,  mass,  and 
moments  of  inertia  as  defined  in  a SNAME  publication 1 . The  vehicle 

length  and  speed,  whether  the  vehicle  is  a towed  or  self-propelled  body 
(inputed  by  means  of  a disk  data  file) , and  the  range  of  loop  gains  to 
be  analyzed  (inputed  systematically  from  an  interactive  terminal) . 

The  main  program  computes  the  coefficients  of  the  numerator  and 
denominator  equations  that  are  shown  in  Appendix  B.  This  calculation 
is  broken  down  into  four  basic  segments;  one  segment  for  each  loop 
analyzed.  The  resulting  polynomial  equations  are  solved  for  the  roots 
of  the  system  by  using  a polynomial  root  factoring  routine. 

At  the  completion  of  the  main  analysis  program,  a data  file  can  be 
automatically  written  for  a companion  program  known  as  TIMEPLT  (Appen- 
dix D) . TIMEPLT  is  another  analysis  program  which  takes  the  S-domain 


JAir  Force  Flight  Dynamics  Laboratory  Research  and  Technology 
Division,  Wright-Patterson  Air  Force  Base,  Analysis  of  Multiloop 
Vehicular  Control  Systems,  by  D.  T.  McRuer,  I.  L.  Ashkenas,  and 
H.  R.  Pass,  March  1964. 

/ 9 \ 

'Society  of  Naval  Architects  and  Mechanical  Engineers,  Nomenclature 
for  Treating  the  Motion  of  a Submerged  Body  through  a Fluid, 

1952. 
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analysis  and  transfers  it  back  into  the  time  domain,  complete  with  plot 
diagrams  of  the  system  output  response  due  to  standard  input  signals. 


INPUT  REQUIREMENTS 

Data  input  to  the  object  program  L0CSAP/0BJECT  is  through  the  disk 
data  file  L0CSAP/DATA  and  from  an  interactive  terminal.  All  inputs  are 
in  a free-field  format.  Refer  to  Figure  6 for  an  example  of  data  file 
input . 


INTERACTIVE  TERMINAL  DATA 

As  described  earlier,  the  control  system  analysis  proceeds  by 
closing  each  successive  feedback  loop . This  is  accomplished  by  input- 
ing  a range  of  loop  gains  for  the  innermost  loop  and  then  deciding  on 
a single  value  before  proceeding  to  the  next  system  loop.  At  any  point 
in  the  analysis,  the  operator  is  allowed  to  change  any  previous  loop 
gains  until  a full  set  of  four  loop  gains  have  been  chosen.  Details 
of  the  interactive  terminal  data  can  be  found  in  the  example  problem 
(Figure  7). 


EXAMPLE  PROBLEM* 

The  program  is  executed  as  follows: 

??EX  L0CSAP / 0B JECT  * [charge  number] 

FILE  FILE  1 - L0CSAP/DATA;END. 

At  the  interactive  terminal,  the  programer  is  now  allowed  to  have 
outputed  three  different  data  sets.  The  program  prints  the  statement: 

PRINT  STAB  DERIV,  DIMRTS , TFCPRT  . . . 

These  data  sets  are  the  vehicle  nondiraensional  stability  derivatives 
(input  to  the  program  from  the  previously  mentioned  data  file  L0CSAP/ 
DATA),  the  dimensional  polynomial  roots,  and  the  dimensional  polynomial 
coefficients,  respectively.  A "1"  input  for  each  of  the  variables  al- 
lows the  data  to  be  printed  out;  an  "0"  means  that  the  printout  is  not 
desired.  Following  these  data  sets,  the  numerator  roots  (zeros)  for 
the  four  control  system  loops  are  printed. 


*This  example  problem  is  for  a self-propelled  vehicle,  consequently 
some  additional  terms  are  zeroed  by  the  program. 

(Text  Continued  on  Page  14) 
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Line 

Number 


Data  Description 


Record 

1 

0000: 

10.1270,  49.3330,  0,* 

Record 

2 

0010: 

-. 15020E-01, 

- . 57700E-03 , 

. 81000E-04,/ 

0020: 

.0 

-. 50138E-01, 

. 95500E-02, / 

0030: 

.0 

.0 

- . 15709E  00,/ 

0040: 

.0 

-. 17455E-01, 

-. 11310E-01, / 

0050: 

-.16230E-02, 

.0 

.0  ,/ 

0060: 

.0 

-. 31545E-01, 

-.14600E-03,/ 

0070: 

.0 

-. 13000E-03, 

-. 15730E-02, / 

0080: 

.0 

.0 

.0  ,/ 

0090: 

.0 

.0 

.0  ,/ 

0100: 

.0 

-. 27695E-01, 

-. 12797E-01, / 

0110: 

. 36397E-01, 

. 19170E-02 , 

Note:  The  following  information  identifies  the  input  by  record, 

column,  and  line. 

UQ,  LB,  [Type] 

Record  1 0000:  U 0 - Vehicle  Velocity  (ft/sec) 

LB  - Vehicle  length  (ft) 


[Type]  - 

1 if  a towed  body, 

0 if  self-propelled 

Record  2*  0010: 

XU 

, ZU  , MU 

0020: 

X W 

, ZW  , MW 

0030: 

XTHUSQ** 

, ZTHUSQ**,  MTHUSQ** 

0040: 

XQ 

, ZQ  , MQ 

0050: 

XUD 

, ZUD  , MUD 

0060: 

XWD 

, ZWD  , MWD 

0070: 

XQD 

, ZQD  , MQD 

0080: 

XX 

, ZX  , MX 

0090: 

XZ 

, ZZ  , MZ 

0100: 

XDELT 

, ZDELT  , MDELT 

0110: 

M,  IY 

> 

*Nondimensional  Stability  Derivatives  (Appendix  A) 

**Program  reads  XTHUSQ(=X'  U2) , ZTHUSQ,  MTHUSQ  and  converts 
to  XTH(  - XTHUSQ/U2) , Zra,°MTH 

FIGURE  6.  EXAMPLE  DATA  FILE 
11 


5 : LOCSAP/ 0BJECT  - 1 BOJ  1302  10/01/74  FROM  01/06 
PRINT  STAB  DERIV.  DIMRTS,  TFCPRT. . . 

1,1,1*- 


S N A M E NON-DIMENSIONAL 
LONGITUDINAL  STABILITY  DERIVATIVES 


XU 

c s 

15020E-01 

ZU 

3 

xw 

= 

.0 

ZW 

= 

XTH 

= 

.0 

ZTH 

= 

XQ 

= 

.0 

ZQ 

= 

XUD 

= 

-.16230E-02 

ZUD 

= 

XWD 

= 

.0 

ZWD 

= 

XQD 

= 

.0 

ZQD 

= 

XX 

= 

.0 

ZX 

= 

XZ 

= 

.0 

ZZ 

S S 

XDELT 

3 

.0 

ZDELT 

3 

M . 36397E-01 


57700E-03 

MU 

. 81000E-04 

-.50138E-01 

MW 

. 95500E-02 

.0 

MTH 

. 15317E-02 

-.17455E-01 

B 

II 

1 

• 11310E-01 

.0 

MUD  = 

.0 

31545E-01 

MWD  = - 

. 14600E-03 

-.13000E-03 

MQD 

. 15730E-02 

.0 

MX 

.0 

.0 

MZ 

.0 

27695E-01 

MDELT  = - 

. 12797E-01 

IY 

. 19170E-02 

****  DENOMINATOR  DS(J)  **** 


DIMENSIONAL  COEFFICIENTS 


J - 1 

J = 2 

J = 3 

J = 4 

J = 5 

J = 6 

J = 7 


DS  = .0 

DS  = .0 

DS  - . 273739387358E-04 

DS  = . 118877286995E-02 

DS  = . 185102157604E-01 

DS  « . 108587460950E  00 

DS  = . 120470690538E  00 

DIMENSIONAL  ROOTS 


J = 

1 

ROOTR  = 

59231E-01 

ROOTI  = 

-.22004E-01 

J = 

2 

ROOTR  = 

-.59231E-01 

ROOT I = 

. 22004E-01 

J = 

3 

ROOTR  * 

81096E-01 

ROOTI  = 

.0 

J - 

4 

ROOTR  = 

-.70180E  00 

ROOTI  = 

.0 

J = 

5 

ROOTR  = 

.0 

ROOTI  = 

.0 

J = 

6 

ROOTR  = 

.0 

ROOTI  = 

.0 

****  X NUMERATOR 

**** 

***** 

XS(J)  COEFFICIENTS  ALL  ZERO 

***** 

FIGURE  7.  EXAMPLE  PROBLEM 
(Sheet  1 of  2) 
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****  Z NUMERATOR  **** 


DIMENSIONAL  COEFFICIENTS 


J = 1 

ZS  = 

.0 

J = 2 

ZS  = 

- . 153127243398E-03 

J = 3 

ZS  * 

- . 116585064408E-01 

J = 4 

ZS  = 

- . 1286I4635109E  00 

J = 5 

ZS  = 

- . 100337496561E  00 

DIMENSIONAL 

ROOTS 

J = 

1 

ROOTR  = 

-. 15883E-01 

ROOT I = 

.0 

J = 

2 

ROOTR  = 

-. 81096E-0I 

ROOTI  = 

.0 

J - 

3 

ROOTR  = 

-. 11848E  01 

ROOTI  = 

.0 

J = 

4 

ROOTR  = 

.0 

ROOTI  = 

.0 

****  I NUMERATOR  **** 

DIMENSIONAL  COEFFICIENTS 

J 

- 

1 

TS  = 

.0 

J 

= 

2 

TS  = 

.0 

J 

= 

3 

TS  - 

-. 322969154535E-03 

J 

= 

4 

TS  = 

- . 548520303593E-02 

J 

= 

5 

TS  = 

-. 185293864 643E-01 

DIMENSIONAL 

ROOTS 

J = 

1 

ROOTR 

= - . 81096E-01 

ROOTI  = 

.0 

J = 

2 

ROOTR 

= -. 21493E  00 

ROOTI  = 

.0 

J = 

3 

ROOTR 

= .0 

ROOTI  = 

.0 

J = 

4 

ROOTR 

= .0 

ROOTI  = 

.0 

ZEROS  OF  TD/E1 


-0.0811  0.0000 

0.0000  0.0000 

-0.2149 

0.0000 

0. 0000 

0. 0000 

0.0000 

0.0000 

ZEROS  OF  T/E2 
-0.0811  0.0000 

-0.2149 

0.0000 

0. 0000 

0.0000 

0. 0000 

0.0000 

ZEROS  OF  ZD/E3  AND 
-0.0811  0.0000 

Z/ZO 

-0.3690 

0.0000 

1.0384 

0. 0000 

0. 0000 

0. 0000 

0.0000  0.0000 


FIGURE  7. 
(Sheet  2 of  2) 
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FIRST  LOOP  ANALYSIS 

To  analyze  the  first  loop  (pitch  rate) , the  initial  value  of  Kg 
must  be  entered  along  with  the  step  increment,  AKg,  and  the  final 
value  of  Kq.  The  program  prints  out  the  statement: 

ENTER  KTD0RG , DELKTD , KTDFIN. 

The  programmer  must  then  enter  the  desired  values  as  follows: 

0,  .5,  5. 

A root  locus  for  the  inner  loop  will  then  be  generated  for  the  gain 
values  of  0 to  5 in  steps  of  .5  (Figure  8). 

ENTER  KTDORG, DELKTD, KTDFIN 

0,  .5,5*- 


0.00 
-0. 0592 

-0.0220 

-0.0592 

0.0220 

-0.  0811 

0.  0000 

-0.7018 

0.0000 

0.0000 

0.0000 

0.0000 

0. 0000 

0.50 

-0.0407 

0.0000 

-0.0811 

0. 0000 

-0.0897 

0.  0000 

-0.7667 

0.  0000 

0.0000 

0.0000 

0.0000 

0.0000 

1.00 

-0.0307 

0.0000 

-0.0811 

0.0000 

-0. 1094 

0.0000 

-0.8340 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

1.50 

-0.0253 

0.0000 

-0.0811 

0. 0000 

-0.1227 

0. 0000 

-0. 9030 

0. 0000 

0.0000 

0.0000 

0.0000 

0.0000 

2.00 

-0.0217 

0.0000 

-0.0811 

0. 0000 

-0. 1328 

0.0000 

-0.9734 

0. 0000 

0.0000 

0.0000 

0.0000 

0.0000 

2.50 

-0.0190 

0.0000 

-0.0811 

0.0000 

-0. 1409 

0.0000 

-1.0449 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

3.00 

-0.0170 

0.0000 

-0.0811 

0. 0000 

-0. 1475 

0.0000 

-1.1172 

0.0000 

0.0000 

0. 0000 

0. 0000 

0.0000 

3.50 

-0.0154 

0.0000 

-0.0811 

0. 0000 

-0.1531 

0.0000 

-1. 1901 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

. 4.00 
-0.0141 

0.0000 

-0.0811 

0.0000 

-0. 1578 

0.0000 

-1.2637 

0.0000 

0.0000 

0.0000 

0.0000 

0. 0000 

4.50 

-0.0129 

0,0000 

-0.0811 

0.0000 

-0. 1618 

0.0000 

-1.3376 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

5.00 

< 

t 

-0.0120 

0.0000 

-0.0811 

0.0000 

-0. 1654 

0.0000 

-1.4119 

0.0000 

0.0000 

0.0000 

0.0000 

0. 0000 

FIGURE  8. 

EXAMPLE 

PROBLEM 

: FIRST 

LOOP  ANALYSIS 

Each  root  is  listed  as  a real  and  imaginary  pair,  read  from  left 
to  right,  top  and  bottom.  For  example,  at  a gain  value  Kg  = 0.00  (first 
three  digit  number  printed)  the  denominator  roots  (poles)  are 
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Real 

Imaginary 

-.0592 

-j  .0220 

-.0592 

+j  .0220 

-.0811 

JO 

-.7018 

JO 

While  the  loop  zeros  (previously  printed  out)  are 


Real 

Imaginary 

-.0811 

JO 

-.2149 

JO 

0.0 

JO.O 

The  two  zero  vlaue  roots  for  each  are  not  shown  since  this  example  is 
for  a self-propelled  vehicle;  for  a towed  vehicle  they  would  have  a 
nonzero  value. 

Figure  9 is  a plot  of  the  root  locus  for  this  loop. 

After  printing  the  value  for  the  roots  over  the  gain  range  speci- 
fied, the  program  will  then  print  out  the  next  statement: 


FIGURE  9.  ROOT  LOCUS  FOR  THE  FIRST  LOOP 
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D0  Y0U  WANT  T0  C0TINUE  KTD  R.L0CUS. 

The  programmer  must  enter: 

0 - if  he  desires  to  go  on  to  the  second  loop. 

1 - if  he  desires  to  continue  the  root  locus  in  the  first 

loop. 

If  1 is  entered,  the  program  will  again  ask  for  values  of  KTD0RG, 
DELKTD , KTDFIN . 

If  0 is  entered,  the  program  will  ask  for  the  desired  first  loop 
gain  by  printing  ENTER  KTD.  The  programmer  must  enter  the  se- 
lected first  loop  gain. 


SECOND,  THIRD,  AND  FOURTH  LOOPS 

The  above  procedure  is  repeated  for  the  next  three  loops.  When 
new  values  are  requested  at  the  end  of  each  root  locus,  three  options 
are  available.  This  is  to  allow  the  programmer  to  go  back  to  any 
desired  inside  loop  at  any  point  in  the  program.  For  example,  if  after 
completing  the  root  locus  in  the  second  loop,  the  programmer  may  wish 
to  reanalyze  the  first  loop  based  on  what  he  learned  from  the  second 
loop  root  locus.  This  is  accomplished  as  follows.  The  program  prints 
out  the  statement 

DO  / Y0U  WANT  NEW  KTD,  0 - N0,  1 = ENT,  2 - ENT  & C0MP,  KTD  N0W  = 1 
after  the  second  loop  root  locus  is  complete.  The  programmer  must  enter 

0 - If  he  desires  to  go  to  the  third  loop, 

1 - If  he  desires  to  change  the  value  of  the  first  loop  gain, 

2 - If  he  desires  to  go  back  to  the  first  loop  and  recompute  the 

root  locus. 

This  return  option  is  available  at  the  completion  of  each  loop’s  locus. 

For  the  fourth  loop,  two  gain  values  are  printed,  the  loop  gain 
and  the  system  gain.  The  system  gain  is  defined  as 

GAIN  m K ^ 

GAIN  KZ  DS  (5) 
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for  self-propelled  vehicles  (see  Appendix  B for  definition  of  terms). 
The  gain  is  the  steady  state  value  for  depth,  Z,  for  a unit  step  in 
depth  command,  Z0.  Normally,  it  is  desirable  for  this  gain  value  to 
be  equal  to  unity. 

The  remainder  of  the  vehicle  control  system  analysis  follows  as 
shown  in  an  example  problem  (Figure  10) , along  with  root  locus  plots 
for  the  second,  third,  and  fourth  loops  (Figures  11,  12,  and  13). 

When  the  programmer  is  satisfied  with  the  analysis  and  has  se- 
lected gain  values  for  all  four  loops,  the  program  prints  out 

D0  Y0U  WANT  A TIMEPLT. 

By  inputing  a 1 (yes)  to  the  L0CSAP  program,  a data  file  is  auto- 
matically created  which  will  later  be  utilized  by  the  program  TIMEPLT. 
The  root  values  to  be  passed  to  the  file  are  determined  by  the  opera- 
tors answer  to  the  next  two  questions  asked  of  him  by  the  program. 

ENTER  KTD,  KT,  KZD,  KZ,  GAMP 

TIMEPLT  F0R  WHICH  L00P  . 

The  K values  are  the  individual  loop  gains,  and  the  variable  GAMP  is 
indicative  of  the  type  and  magnitude  of  the  standard  test  signal  to  be 
inputed  to  the  system.  Answering  the  question  as  to  which  loop,  deter- 
mines which  loop  output  will  be  plotted  by  the  companion  program.  This 
analysis  can  be  repeated  as  many  times  as  desired,  until  the  operator 
answers  N0  (0)  to  the  question: 

D0  Y0U  WANT  AN0THER  TIMEPLT, 
at  which  point  the  root-locus  program  is  terminated. 


CONCLUSIONS 


A computer  program  was  written  utilizing  the  root-locus  technique 
to  analyze  a longitudinal  feedback  control  system.  An  example  problem 
is  included  illustrating  the  use  of  this  program. 

To  date,  this  analysis  program  has  been  utilized  in  the  design  of 
control  systems  for  swimmer  delivery  vehicles,  a submarine,  and  towed 
mine-hunting  vehicles . 
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DO  YOU  WANT  TO  CONTINUE  KTD  R.  LOCUS 
0<- 

ENTER  KTD 
1-*- 

ENTER  KTORG , DELKT , KTFIN 
0,-.5,-5«- 
0.00 


-0.0307 

0.0000 

-0.0811 

0. 0000 

-0.1094 

0. 0000 

-0.8340 

0.0000 

0.0000 

-0.50 

0.0000 

0.0000 

0.0000 

-0.1150  - 

-0.1130 

-0.1150 

0.1130 

-0.  0811 

0. 0000 

-0.7441 

0. 0000 

0.0000 

-1.00 

0.0000 

0.0000 

0.0000 

-0.1724  - 

-0.1651 

-0.1724 

0.1651 

-0.0811 

0. 0000 

-0.6292 

0.0000 

0.0000 

-1.50 

0.0000 

0.0000 

0. 0000 

-0.0811 

0.0000 

-0.2584 

-0.2186 

-0.  2584 

0.2186 

-0.4572 

0. 0000 

0.0000 

-2.00 

0.0000 

0.0000 

0. 0000 

-0.0811 

0.0000 

-0.3110 

0.0000 

-0.  3315 

-0.3342 

-0. 3315 

0.3342 

0.0000 

-2.50 

0.0000 

0.0000 

0.0000 

-0.0811 

0.0000 

-0.2726 

0. 0000 

-0.  3508 

-0.4364 

-0.3508 

0.4364 

0.0000 

-3.00 

0.0000 

0.0000 

0. 0000 

-0.0811 

0.0000 

-0.2565 

0.0000 

-0. 3588 

-0.5185 

-0.3588 

0.5185 

0.0000 

-3.50 

0.0000 

0.0000 

0. 0000 

-0.0811 

0.0000 

-0.2476 

0.0000 

-0.  3632 

-0.5888 

-0.3632 

0.5888 

0.0000 

0.0000 

0.0000 

0.0000 

-4.00 

0.0811 

0.0000 

-0.2410 

0.0000 

0.3661 

0.6514 

-0.3661 

0.6514 

0.0000 

0.0000 

0.0000 

0.0000 

-4.50 

-0.0811 

0.0000 

-0.2379 

0. 0000 

-0.3681 

-0.7083 

-0.3681 

0.7083 

0.0000 

-5.00 

0.0000 

0.0000 

0.0000 

-0.0811 

0.0000 

-0.2349 

0. 0000 

-0.  3696 

-0.  7609 

-0.3696 

0. 7609 

0.0000 

0.0000 

0.0000 

0.0000 

DO  YOU  WANT 

NEW  KTD 

, 0=NO, 1=ENT, 2=ENT&COMP , KTD 

N0W=  1, 

.00 

0** 

DO  YOU  WANT  TO  CONTINUE  KT  R.  LOCUS 
0- 


FIGURE  10.  EXAMPLE  PROBLEM:  SECOND,  THIRD  AND  FOURTH  LOOP  ANALYSIS 

(Sheet  1 of  5) 
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ENTER  KT 
— 1*- 

ENTER  KZDORG , DELKZD , KZDF IN 
0,  .5,5*- 


0.00 

-0.1724  - 

-0.1651 

-0.1724 

0.1651  - 

-0.0811 

0.0000 

-0.6292 

0. 0000 

0.0000 

0.0000 

0.0000 

0.0000 

0.50 

-0.0811 

0.0000 

-0.3992 

0.0000  - 

•0.0792 

-0.6952 

-0.0792 

0.6952 

0.0000 

0.0000 

0.0000 

0. 0000 

1.00 

-0.0811 

0.0000 

-0.3839 

0.0000 

0.1213 

-0.9539 

0.1213 

0.9539 

0.0000 

0.0000 

0.0000 

0.0000 

1.50 

-0.0811 

0.0000 

-0.3788 

0. 0000 

0.3270 

-1.1186 

0.3270 

1.1186 

0.0000 

0.0000 

0.0000 

0.0000 

2.00 

-0.0811 

0.0000 

-0.3764 

0.0000 

0.5340 

-1.2271 

0.5340 

1.2271 

0.0000 

0.0000 

0.0000 

0.0000 

2.50 

-0.0811 

0.0000 

-0.3749 

0.0000 

0.7415 

-1.2938 

0.7415 

1.2938 

0.0000 

0.0000 

0.0000 

0.0000 

4.00 

-0.0811 

0.0000 

-0.3739 

0.0000 

0.9492 

-1.3249 

0.9492 

1.3249 

0.0000 

0.0000 

0 0000 

0.0000 

3.50 

-0.0811 

0.0000 

-0.3732 

0.0000 

1.1571 

-1.3229 

1.1571 

1.3229 

0.0000 

0.0000 

0.0000 

0.0000 

3.00 

-0.0811 

0.0000 

-0.3726 

0.0000 

1.3650 

-1.2877 

1.3650 

1.2877 

0.0000 

0.0000 

0.0000 

0. 0000 

4.50 

-0.0811 

0.0000 

-0.3722 

0.0000 

1.5731 

-1.2164 

1.5731 

1.2164 

0.0000 

0.0000 

0.0000 

0. 0000 

5.00 

-0.0811 

0.0000 

-0.3719 

0.0000 

1.7811 

-1. 1019 

1. 7811 

1.1019 

0.0000 

0.0000 

0.0000 

0.0000 

DO  YOU  WANT 

0*- 

NEW  KTD, 

, KTD  NOW 

= 1.00 

DO  YOU  WANT 

NEW  KT, 

KT  NOW  = 

-1.00 

0*- 

DO  YOU  WANT  TO  CONTINUE  KZD  R.  LOCUS 
1*- 

ENTER  KZDORG, DELKZD, KZDFIN 
0,-.5,-3*- 


FIGURE  10. 
(Sheet  2 of  5) 
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0. 0000 


-0.6292  0.0000 


0.00 

-0.1724 

-0.1651 

-0.1724 

0.0000 

0.0000 

0.0000 

-0.50 

-0.0811 

0.0000 

0.2740 

0.0000 

0.0000 

0. 0000 

-1.00 

-0.0811 

0.0000 

-0.3547 

0.0000 

0.0000 

0.0000 

-1.50 

-0.3594 

0.0000 

0.5174 

0.0000 

0.0000 

0.0000 

-2.00 

-0.0811 

0.0000 

-0.3617 

0.0000 

0 0000 

0.0000 

-2.50 

-0.0811 

0.0000 

-0.3632 

0.0000 

0.0000 

0.0000 

-3.00 

-0.0811 

0.0000 

-0.3641 

0.0000 

0.0000 

0.0000 

DO  YOU  WANT 

NEW  KTD. 

, KTD  NOW  = 

0<- 

DO  YOU  WANT 

NEW  KT, 

KT  NOW  = 

(h- 

DO  YOU  WANT 

TO  CONTINUE  KZD  R. 

CK 

ENTER  KZD 
0, . 5,5«- 
0.00 

GAIN  = 0. 

000 

-0.1724 

-0.1651 

-0.1724 

0.0000 

0.0000 

0.0000 

0.50 

GAIN  = -2. 

710 

-0.0811 

0.0000 

-0.3803 

-0.5216 

0.8133 

0.0000 

1.00 

GAIN  = -5. 

421 

-0.0811 

0.0000 

-0.3745 

-0.5787 

1.0922 

0.0000 

1.50 

GAIN  = -8. 

131 

-0.0811 

0.0000 

0.6230 

-0.6122 

1.2989 

0.0000 

0.1651  -0.0811 

0.0000 

0.0000  -0.3410  0.0000  -1.3235 

0.0000 


0. 0000 
0.0000 

0.4253 

0. 0000 

-1.8776 

0.0000  - 
0.0000 

-0. 0811 

0. 0000 

-2. 3814 

0.0000 

0.0000 

0. 5822 

0. 0000 

-2.8603 

0.0000 

0.0000 

0.6311 

0. 0000 

-3.3242 

0.0000 

0.0000 

1.00 

0.6698 

0. 0000 

-3.7783 

-1.00 

LOCUS 

0.1651  • 

0.0000 

-0.0811 

0.0000 

0. 0000 
0. 0000 

-0.6292 

0.0000 

0.0000 

0.4495 

0.0000 

0.0000 
0. 0000 

-0.5216 

0.0000 
0. 0000 

0.5577 
0. 0000 

0. 0000 
0.0000 

-0.5787 

0.0000  ■ 
0.0000 

-0.3726 
0. 0000 

0. 0000 
0. 0000 

-0.6122 

FIGURE  10. 
(Sheet  3 of  5) 


0. 0000 
0.0000 
0.0000 
0.0000 
0. 0000 
0. 0000 


0.0000 

0.8133 

1.0922 

1.2989 
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2.00 

GAIN  = -10.841 


-0.0811  0.0000 
-0.6357  1.4705 

2.50 

GAIN  = -13.552 

-0.3717 

0.0000 

0.0000 

0.0000 

0.6690 

0.0000 

0.0000 

0.0000 

-0.6357 

-1.4705 

-0.0811  0.0000 
-0.6535  1.6204 

3.00 

GAIN  = -16.262 

-0.3711 

0.0000 

0.0000 

0.0000 

0.7041 

0.0000 

0.0000 

0.0000 

-0.6535 

-1.6204 

-0.0811  0.0000 
-0.6677  1.7552 

3.50 

GAIN  - -18.972 

-0.3708 

0.0000 

0.0000 

0.0000 

0.7321 

0.0000 

0.0000 

0.0000 

-0.6677 

-1.7552 

-0.0811  0.0000 
-0.6794  1.8788 

4.00 

GAIN  * -21.683 

-0.3705 

0.0000 

0.0000 

0.0000 

0.7552 

0.0000 

0.0000 

0.0000 

-0.6794 

-1.8788 

-0.0811  0.0000 
-0.6892  1.9937 

4.50 

GAIN  = -24.393 

-0.3703 

0.0000 

0.0000 

0.0000 

0. 7746 
0.0000 

0.0000 

0.0000 

-0.6892 

-1.9937 

-0.0811  0.0000 
-0.6976  2.1014 

5.00 

GAIN  - -27.103 

-0.3702 

0.0000 

0.0000 

0.0000 

0.7913 

0.0000 

0.0000 

0.0000 

-0.6976 

-2.1014 

-0.0811  0.0000 
-0.7049  2.2032 

-0.3701 

0.0000 

0.0000 
0 . 0000 

0.8058 

0.0000 

0.0000 

0.0000 

-0.7049 

-2.2032 

DO  YOU  WANT  NEW  KTD,  KTD  NOW  = 1.00 

CH- 


DO  YOU  WANT  NEW  KT,  KT  NOW  = -1.00 

0*- 

DO  YOU  WANT  NEW  KZD,KZD  NOW  = 0.00 

0*- 

DO  YOU  WANT  TO  CONTINUE  KZ  R.  LOCUS 
1-h 

ENTER  KZORG , DELKZ , KZFIN 
0,-.5,-> 

0.00 

GAIN  = 0.000 


-0.1724 

-0.1651 

-0.1724 

0.1651 

-0.0811 

0.0000 

-0.6292 

0.0000 

0.0000 

-0.50 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

GAIN  = 2. 

710 

-0.0811 

0.0000 

-0.3586 

0.0000 

0.3000 

-0.5254 

0. 3000 

0.5254 

-1.2154 

0.0000 

0.0000 

0.0000 

0.0000 

0.0000 

-1.00 
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GAIN  = 5.421 


-0.0811  0.0000 
-1.5113  0.0000 

-1.50 

GAIN  = 8.131 

-0.3637 

0.0000 

0.0000 

0.0000 

0.4504 
0. 0000 

-0.6146 

0.0000 

0.4504 

0.6146 

-0.0811  0.0000 
-1.7345  0.0000 

-2.00 

GAIN  = 10.841 

0.5629 

0.0000 

-0.6620 
0. 0000 

0.5629 
0. 0000 

0.6620 
0. 0000 

-0.3654 

0. 0000 

-0.0811  0.0000 
-1.9206  0.0000 

-2.50 

GAIN  = 13.552 

0.6564 

0.0000 

-0.6901 

0.0000 

0.6564 

0.0000 

0.6901 
0. 0000 

-0.3663 

0. 0000 

0.7380  -0.7066 

-2.0832  0.0000 
-3.00 

GAIN  - 16.262 

0.7380 
0. 0000 

0.7066 
0. 0000 

-0.0811 

0.0000 

0. 0000 
0. 0000 

-0.3668 

0.0000 

-0.0811  0.0000 
-2.2293  0.0000 

-0.3672 
0. 0000 

0.0000 
0. 0000 

0.8112 
0. 0000 

-0. 7151 
0.0000 

0.8112 

0. 7151 

DO  YOU  WANT  NEW  KTD.KTD  NOW  = 1.00 

0+- 

DO  YOU  WANT  NEW  KT,  KT  NOW  = -1.00 

0+- 

DO  YOU  WANT  NEW  KZD,KZD  NOW  = 0.00 

(K 

DO  YOU  WANT  TO  CONTINUE  KZ  R.  LOCUS 
0<- 

DO  YOU  WANT  A TIMEPLT 

1- «- 

ENTER  KTD,KT,KZD,KZ,GAMP 

1,-1, 0,0, 10<- 

TIMEPLT  FOR  WHICH  LOOP;  ENTER  1=1ST,  2=2ND,  3-3RD,  4=4TH 

2- *- 

DO  YOU  WANT  ANOTHER  TIMEPLT 
0+- 


PROCESSOR  TIME 

= 

15  SEC 

$ 

0.60 

I/O  TIME 

ss 

23  SEC 

$ 

0.46 

PRORATED  TIME 

= 

249  SEC 

$ 

2.49 

TOTAL  COST 

$ 

3.55 

LOCSAP /MILLER  = 

1 

EOJ  1326 

FIGURE  10. 
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FIGURE  12.  ROOT  LOCUS  FOR  THE  THIRD  LOOP 


FIGURE  13.  ROOT  LOCUS  FOR  THE  FOURTH  LOOP 
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APPENDIX  A 


SOME  NOTES  ON  THE  CONSTRUCTION  AND 
INTERPRETATION  OF  ROOT  LOCUS 


A physical  system  can  be  represented  by  a block  diagram  composed 
of  individual  blocks  that  represent  the  various  components  of  the  sys- 
tem as  shown  in  Figure  Al.  Each  block  is  described  by  one  or  more 


FIGURE  Al.  A TYPICAL  BLOCK  DIAGRAM 


differential  equations  according  to  Newton's  Second  Law  of  Motion  or 
its  electrical  equivalent.  Combining  the  characteristics  of  each  block 
to  form  the  characteristics  of  the  overall  system  is  quite  difficult 
because  a signal  is  modified  in  both  phase  and  amplitude  in  going 
through  each  block.  By  applying  the  Laplace  transform 

00 

F (s)  - J f (t) e-St  dt 
0 

to  the  describing  differential  equations,  one  obtains  an  algebraic  rep- 
resentation for  each  block  in  the  system.  It  is  then  convenient  to 
arrange  this  representation  in  the  form  of  a transfer  function;  i.e., 
as  a ratio  of  block  response  to  block  excitation.  These  transfer  func- 
tions can  be  be  multiplied  together  to  yield  system  response  to  system 
excitation.  It  is  a relatively  straightforward  procedure  because  each 
transfer  function  is  merely  a ratio  of  polynomials  in  the  Laplace 
operator  s . 


A-l 


Once  the  transfer  functions  for  each  of  the  blc  .'V  s i. 

formed,  it  Is  then  necessary  to  examine  the  effects  of  changing  vari- 
ous unknown  system  parameters,  such  as  feedback  gain  on  the  system 
dynamics.  The  root-locus  diagram  was  developed  to  facilitate  such  an 
analysis.  As  the  name  implies,  it  shows  on  one  figure  the  trajectory 
that  the  frequency  and  damping  characteristic  modes  follow  as  system 
parameters  are  changed. 

Consider  the  transfer  function 

0 _ K(s  + a)(s2  4-  bs  + c) 

1 s(s  + d)  (s  + e)(8*  + fs  + g) 

The  denominator  of  the  transfer  function  represents  the  characteristic 
equation  of  the  system;  e.g.,  the  equation  describing  the  free  motion 
of  the  system  (the  response  independent  of  control  input) . It  is  re- 
sponsible for  the  general  solution  of  the  system  of  differential  equa- 
tions. The  particular  solution  comes  from  the  numerator. 

It  will  be  observed  that  all  values  of  s which  make  the  denomina- 
tor zero  are  solutions  of  the  characteristic  equation  and  therefore 
contlrbute  a term  of  the  e^fc  to  the  time  response.  Since  for  these 
roots  the  transfer  function  is  undefined,  denominator  roots  are  called 
poles.  Numerator  roots  are  appropriately  called  zeros.  It  is  customary 
to  plot  these  poles  and  zeros  on  a graph  whose  abscissa  is  the  real 
part  of  s and  whose  ordinate  is  the  Imaginary  part.  Poles  are  commonly 
depicted  as  x's  and  zeros  are  0's.  A first  order  root;  e.g.,  (s  + d) , 
will  always  lie  on  the  abscissa.  A second  order  system  has  two  roots. 
They  may  be  real,  in  which  case  they  lie  on  the  abscissa,  or  they  may 
be  complex,  in  which  case  they  are  placed  equidistant  above  and  below 
the  abscissa. 

Any  pole  which  lies  in  the  right  half  s-plane  represents  an  un- 
stable motion.  Zeros  in  the  right  half  plane  are  significant  in  terms 
of  the  type  motion  only  if  the  system  depicted  is  a feedback  system. 

In  this  case  the  zeros  represent  the  location  of  the  poles  when  the 
feedback  gain  is  made  infinite.  For  zeros  in  the  right  half  plane  then, 
the  system  will  become  unstable  at  some  finite  value  of  feedback  gain. 
Knowledge  of  the  location  of  the  basic  vehicle  zeros  is  needed  by 
designers  to  combine  the  control  system  characteristics  with  those  of 
the  vehicle  to  obtain  the  desired  response  without  unexpected  insta- 
bilities. Note  also  that  a zero  placed  on  top  of  a pole  will  elimi- 
nate the  motion  caused  by  that  pole  from  the  time  history  of  the 
particular  variable  associated  with  the  numerator  (0  in  0/6r)  for 
example)  but  from  no  other  time  history. 

A pole  located  at  s * -3,  for  example,  means  that  there  is  contri- 
bution to  the  time  history  given  by  e”3t.  Thus,  the  further  to  the 
left  the  pole,  the  more  rapid  is  the  subsidence.  Conversely,  a pole 
at  s - 3 means  the  motion  has  an  unstable  component  described  by  e^. 
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Stable  oscillatory  modes,  it  will  be  recalled,  have  roots  which 
can  be  expressed  by 

s.,s,  = -cw  + jiu Jl  - c2 

i z n - n 

Figure  A2  indicates  how  varying  either  frequency  or  damping  ratio 
separately  moves  the  poles.  It  also  shows  that  the  product  deter- 
mines the  time  for  an  oscillation  to  decay  to  half  amplitude.  When 
= 0.591,  the  oscillation  will  decay  to  half  amplitude  in  1 second. 
Smaller  values  of  the  product  mean  the  time  to  damp  to  half  amplitude 
is  longer. 

For  further  details  on  the  construction  and  interpretation  of  root 
locus  diagrams  refer  to  Introduction  to  Automatic  Control  Systems, 

John  Wiley  and  Son,  1962. 


£ = Damping  Ratio  ■ cos  y 

= Undamped  Natural  Frequency 
= Total  Damping 

t = Time  to  reach  0.95  steady  state  value  = 3.0/Ccu 

8 S tl 

t^^_  Time  to  damp  to  half  amplitude  - 0.69/guu^ 

t_  = Time  to  double  amplitude  (unstable  systems  only)  ■ 0.69 / Qto 
l n 

FIGURE  A2 . IMPORTANT  FEATURES  OF  ROOT-LOCUS  DIAGRAM 

(Reverse  Page  A-4  Blank) 
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APPENDIX  B 


EXPRESSIONS  FOR  THE  LONGITUDINAL  TRANSFER 
FUNCTION  COEFFICIENTS 


The  longitudinal  characteristic  equation  is 


i4  . _ <3  . „ <2 


A.  = As  + Bs  + Cs  + Ds  + E 


Long 


where 


~ZiMZrXj. 

~ X±M±Q+An’) 


f 


-*£x**i  ~z^xf  - 


~ZMMjirX^  - (™-  X^  -Mm  (™.'-2j,)X^ 

+ MkZ^  + zAx^Mf  -ZMX^If- Mj) 

-ZAXMr(Jf  ~Mj > ~ < (*»'-Xji.XZ±+~) 
-M^U-X^+^X^  . 


B-l 


+x;U-zJm;  -z„xmm' 


~Kx^K  -KKr%+*»') 
-*k*CK  - *>&*;  - z^xf 

-A ‘fJl(/n'-Zjir)X^  + 

+z«x^K  + zix~<  + xMrzMMf 


-Mj^-xiK  + M*Z&.  * xrxM(zf^') 


jur  M.  ■& 


The  pitch  response  transfer  function  Is 


0 

6 


N 


Long 


V 


,2 


+ V + c9 

\ong 


ML*m  Kr  + * XSeK^r 


c c c 
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The  vertical  velocity  transfer  function  is 


wl 

6 

s 


N 


W 


v'3  + v'2  + V +DW 


ong 


ong 


where 


<£  M* 


- Z'M'-X'  -Z'm'X'- 


XL 


f 


V*"-* 


+ /w£ (m-x^)(z^+/m)  - 
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+ + MS**.X+  + MiZ"  Xf 

- - *s*A<  - 


The  forward  speed  transfer  function  is 


u-  . \ . V’3+  bus'2^-cuS'  + D„ 


ong 


*L< 


ong 


where 
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St  = xiz^  ^ + Mse  z;  * z4^ x; 


C w C 
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LONGITUDINAL  CONTROL  SYSTEM  ANALYSIS 
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(Reverse  Page  C-2  Blank) 


C-l 


0 

1 

u> 


SSF  T 
FILF 
FILF 
FII.F 

C- 


4000 


4001 


3101 


104 

301 


FRFFFf’HM  StQXFQ  PFSET  I 1ST  OOOuOCGo 

l=LrcSAP/OATA.UMU=L)lSl<»SA''F  = '>0»HLncKINr,=  J»RFGURD=lC  OOOoCC 1 0 

3 = n/$,UNn=HEM0TF>l.0C*,HErnon  = 9 00000020 

4sLCCS4H/llMEPLT*UNlTs0isK,«;AvF.s3n»LnC'<,AHtA  = 20n»  OOOuOG3o 

BLOCKING  =3, RFCOPl)  =10  0COO0040 

**********  SHR<;F  FILE  IS  I OC  AP/ j A No?  7 s *********  OUOuOObo 

RFAl  KT  , K Trifif,  ,KTF!N,K/l),K/nntVr.  »KZnFlN,KZ,KZGRU,KZFIN  OOOUOOftG 

Rf  Al  KTnnKr,,KTO,KTOF  I\#NVA|  OUUuOO/O 

D 1 m f N s T n N'  MT0FlfF)»KTf2C^).R/nF.3(;i»H2/0(rt)M1^DF3(6)»nTn£l(6)  OOOuOOdo 

nlMENSflJN  DTEPCrs)  OOOOOOVO 

niMFNSTON  0TI)FlP(6)»Ol0F1ir^).0TL?R(6)*0TL2If6)»020t3R(A)»  OOOoOIOG 

D/DF 31 ( ft ) ,T T TLEF 1 1 ) OOOOO 1 1 0 

Radian  = iflo/(4*ATANn  ) ) 00000120 

HFAD(1»aOOP)  ( T T U E( T ) » I = 1 * 1 11  OOOoClJG 

F CJR  V AT  ( 1 1 A/s  ) 000001  40 

WR1 Tf(  3 ,4001  ) ( TI TLE(  I )»  1 = 1 , 1 1 ) OOOGClbC 

F0RPAT(//,  1 1 A/s)  OOUUC 1 60 

^RITF ( 3»  3101  ) OOOuO  1 /O 

FDRPAT(//*"PHTNt  STAR  OFRTV,  n I MR  T S » TFCPRT,..")  OOUOOt«G 

R F A D (3,/,FNO  = 9o)NVAL,rniMRTS.ITFCPRTi  ISDPRNT=NVAL  OOOoO 1 90 

RFAL  lY,|.n,^,M(J,Mw.MTH,MO,M|in,Mwn,Mon,MX#M7»MnELNMrH|iSO  O0UU02OO 

PEAP(  1 ,/,ENn  = 09)  II,  LB  , I C AR|  f 00UO0210 

FORMAT (///// ) 0000022G 

RFAD(1,/,FND  = 99)XU»7U,M||,X/i,Zw»Mw,YTHUSO,21H|lSO,MThUSO,xG,ZO,Mg,  000u023O 
XUD*ZUn»  Mlif),Xwn,2Wn,MWn,XQD.ZUD»MCD/XX,7X,MX,X7»2/,MZ,X0ELT/  0 0 0 0 0 2 4 0 
ZDFlT,M0£LT*H,TY;XTH  = XrH|JSQ/ril*!));2TH  = ZTHUSQ/(ll*U)  00000?t>0 

MTH=MTHUSy/(U*U>  000O02OO 

311  IF  ( ISnPHNT.FQiO)  GO  TO  3*1  000002/0 

R«ITF  (3»3?l)  OOOoOPHG 

3?i  FORPAT(//?OX,WS  NAME  NiON-D  1 ME  N S I ON  AL  " > OOOUO^YO 

WRIT!  ( 3»  331  > 00000300 

331  FORMAT  ( l 6X,"L0mGI  TUDINAL  STArILITY  DERIVATIVES**//)  00Uo03lG 

WRITF(3,341)XII,7U,MU»XW,7w.MW.XTR,7TH,MTH,X0,ZQ,MG,XIJ0»/U0,MUG,XwG000o0  32G 
,ZWn,MWp.XQO*7Gn»MQD*XX,7x.oX.XZ,/7,MZ,XntLT.ZDFLT»MI)FLT»M,lY,U»LB0000033G 
341  FORMAT  C 1 X,**XH  =”,F  12.S.4X."ZU  = *• , E 1 2 . S » 4 X » " M U = " , E 1 2 . 5 / » 0 0 0 00  3 4 0 


1 X»"XW 
1 X,"XTH 
1 X , **  X 0 


- >F1?.S*/iy,"ZR 
= ",Fl2,'3,Ay,"/]H 
= "#  F 1 2.S  , AX  ,**ZG 


= "R12,b*4X»nPW 
= " , F 1 ? . 5 , 4 x , M M T H 
=".E1?.5,4X,"MC 


- * E 1 ? # 5/ » 
= %E12.5/, 
sH , E 1 ? • 5/ * 


OOOoO  3bG 
000O036G 
000003/0 


m 

1X,"XUD  *",E12.5,AXWU0  s",E12.5.4X,"MUD  = *SE12.5/» 

00000380 

1X,"XWD  ="#Ei2.5»4X>"ZW0  =" , E 1 2 . 5 . 4X , "M WO  *",El2.5/» 

00000  390 

m 

lX,«XQO  *">El2.5»4X,"ZQ0  *"#E12.5#4X,"MQG  ="#E12.5/' 

00000400 

m 

IX, "XX  ="#El2.5,4X,"ZX  =",E12.5.4X,"MX  =",El2.5/, 

00000410 

m 

lX,"XZ  ="*El2.5#AX>"ZZ  S”»E12»5»4X»"HZ  *">E12.5/» 

00000420 

m 

1X,"XDELT  =n#El2.5,4X#HZ0ELT  *" , E 1 2 . 5 , 4X , "MDEl T »",E12.5// 

00000430 

m 

,9X,wM  *%El2.5,AX#"IY  s**>  E 1 2 » 5 // # 

00000440 

- 

9X,"U0  =",El2.5,Ax,"L8  *",£12. 5//) 

00000450 

351 

CONTINUE 

00000460 

110 

FORMAK/.  "J  = ",  10X,"ECQNVa",El9.5> 

000004/0 

DIMENSION  OS(A)>XS(8)#ZSf A).TS(8)#R00TRC8),H00TI(8),Ec0NV(fl) 

00000480 

continue 

00000490 

UO  = U 

00000500 

N = 6 

00000510 

NPlaN+1 

00000520 

ZOs^Q+M 

00000530 

DCSTaLB 

00000540 

IF( ICABlE.FQ.o)  OC st*uo 

00000550 

C- 

00000560 

n C- 

NON-DIMENSIONAL  0(S)  COEFFTClFNTS  FOR  TOWED  VEHICLES 

00000570 

J>  c- 

00000580 

DS(7)*(M-XUD)*Cm-ZW0)*UY-M0Di-XWD*Z0U*MUD 

00000590 

m 

-X8D*ZUD*HW0-(M-XUD)*Z00*Mw0 

00000600 

m 

-XWO*ZUD*( IY-MQn)-XQ0*(M-7wn)*MUD 

00000610 

DS(6)a-XU*(M-7Wn)*( IY-MOO)-(M-XUD)*ZW*( lY-MQn)-(M-XUO)*f M-ZWO>*MC 

00000620 

m 

-XW*ZODAMUD-XWO*ZQ*MUD-XWD*?On*MU 

O0OUO63O 

m 

-XO*ZUD*MwO-XQO*ZU*MWD-XQO*7Un*MW 

00000640 

m 

♦XU*ZQD*MWo-(M-XUD)*Zy*MWn-f M-XUD )*ZOD*MW 

00000650 

m 

-XW*ZUO*(lY-MQO>-XWO*ZU*( lY-MoO)+XWO*ZUO*MO 

00000660 

m 

-XQ*CM-ZWD)*MUD4-XQO*Zw*MUO-XQn*(M-7WD)*MU 

000006/0 

0SC5)s-XX*(M-7Wn)*( IY-MQO)+XU*ZW*(lY-MQD)-(M-XUn)*ZZ*( I y-MOD ) 

00000680 

m 

♦XU*MO*(M-zWo)+fM-xuO)*ZW*MO-rM“XUn)*(M-ZWD)*MTH 

00000690 

m 

-XZ*ZQD*Mun-XW*7Q*MU0-XWn*7TH*MUD-XW*MU*ZQD-XWD*ZQ*MU-XwD*ZQD*MX 

OQOuO 700 

m 

-XTH*ZUD*MWD-XQ*ZU*MWU-X«n*7X*HWO-xO*ZUD*MW-yOn*ZU*MN-XOD*ZUO*MZ 

00000710 

m 

♦ XX*Z0D*HND  + XU*7Q*MHD-(M-Xlin)*ZTH*MWD  + XU*Z«D*MW 

00000720 

m 

-(M-XU0)*ZQ*MH-fM-XU0)*Z00*M7 

00000730 

m 

•XZ*ZUO*( lY“MQOl“XW*Zu*( IY»MOn)“XWp*ZX*( I Y “MOD  ) 

0OOU0740 

m 

♦ XW*ZU0*M0  + XW0*7U*M0  + XW0*7IID*mTH 

00000750 

-XTH*(P-Zwn)*,-Uln4XO*?»*Mun4X«n*ZZ*VUI)-XQ*(M-7*OW'0 

+ xorww*Mij-xQn*fM-zwn)*Mx 

ns(a)  = xx*zw*(iY-^(jr))*xii*//*fiv”^,:jr'>  + xx*(M-Zwn)*MvJ-xL*/H*M,i 

*CM-XUI))*77*N'Q  + yII*(M-/WD)*',TH+(K,-XII0)*7W*MIH 

-XZ*ZO*MllU-XW*ZrH*MUrl-X/*/Qn*MU-Xw*/Q*MU 

-XWn  + 7TH*Mll-XW*7  0n*h*X-XWn-*7Q*MX 

-XTH*/ll*MN0-X0*7X*Mwn-XTH*/iin*MW-X0*/U*MW 

-XQO*ZX*Mw-x«*7nn*MZ-xon*/n*M7 

+ XX*ZQ*MWl)  + XIJ*ZTH*Mwn  + XX*70n*MW  + Xll*Z«*MH-(M-XUr))*ZrH*ww 

+ xtj*zeo*Mz*{M-xiin)*zo*Mz 

-XZ*Ztl*(IY-MQn)-XW*ZX*(IV-M01)'>  + XZ*7UD*MQ  + XW*7U*M« 

♦ XWn'*7X*^0  + XW*Znn*MlH4Xwn*7l!*MTH 

♦ XTH*ZW*MUf)  + XC)*7Z*Mun-XTH*fv”7W0)  + MU+XQ*/«*yil 
+ XQ0*7Z*MU-xQ*(M-ZWin  *MX  + X0n*7W*MX 

0S(3)=XX*/Z4(|Y-MQD)-xX*7w*M«-XU*Z7*MU+XX*(M-ZWn)*MfH 

-XU*7H*MTH+(M-xnn)*ZZ*MTH 

-XZ*7TH*^Un-X/*7Q4MU-XW*7Tw*Mii-XZ*7«l)*MX 

-XW*7Q*MX-XW[)*7.tH*MX 

“XTH*ZX*Mwn“XTH*ZU*^W“XQ*7v*Mw-XTn*ZtJ0*M7 

-XQ*ZU*MZ-XOI)*Zv*MZ 

4XX*7TH*^Wn  + XV*7Q*Mw  + xll*/Tui*Mw  + xX*7Un*t''Z 

>XU*ZG*M/-(M-XUn)*ZTM*MZ 

-X7*ZX*(TY-M0nUxZ*7U*HQ  + Xw*7x*M('J  + xZ*ZUD*MTH 
♦XW*7U*mTh+XWD*7X*mTm 

+ XTH*/Z*Mun  + XTH*7w*Hll4XQ*/7*M||"XTH*(M“ZwD)*yx 

+XQ*ZW*yX+XoO*Z7*MX 

nS(?)  = -XX*7Z*M«-XX*7w*HTM-xi|*7Z*MTH 

•XZ*/TH*M||-X/*ZO*MX-Xft*ZTH*MX 

•XTH*7X*Mw-xrn*7U*MZ"xQ*ZX*k,Z 

+ XX*ZTH*M^fXX*ZO*M/  + X.j*ZTM*,"Z 

+XZ*ZX*MQ+XZ*7U*mTM+X«*ZX*m!h 

4XTH*ZZ*MUfXT«*7W*MX4Xa*//*wx 

DS(1)=-XX*//*mTh-xZ*ZIh*MX-x!m*Zx*mZ 

+XX*ZTH*M/+XZ*ZY*MTH+xTH*/7*My 

WR  I TF  (3'3) 

3 FClRWAT  (//»?0X»******  uENQP  T NAtUR  DS(J>  ****"} 
no  $ J=i#npi 

4 IF  (DSC  J).  Mr.  o.  n)  GO  in  14 


QOOuC 7 feu 
OOOUO 7 7C 
ooooozac 

OOOuO  79C 
OOOuOfjUC 
OOOUOR 1C 
000 U O07C 
OOOuO 0.  30 

oooooe^c 

0 0 0 u 0 0 b C 
OOOuOflftu 
OOOGCR  7C 
noouottdo 
oooooavc 

000O09OC 
00000910 
000u0970 
000O09 io 
000U099C 
000009bG 
000u0960 
000009  70 
000 00900 
00000990 
OOOulCUu 
000010  10 
00OO 1 07c 

000010 Jc 
0 0 0 0 1 0 « 0 
0 0 o 0 1 0 b 0 
o o u o t o e c 
0 0 0 u 1 0 7 c 
OOOU 1 C 0 C 
OOCOlOVu 
OOOul 1 oc 
0 0 0 U 1 1 1 c 

OOOul  1 7U 
OOOU 1 1 JU 


0 

1 

CT> 


5 

6 
11 

13 

C* 

c- 

c- 

c- 

14 

15 


16 

17 

18 


19 

20 
21 

1 


O 

c- 

c- 


WRITE  ( 3 » 5 ) 

FORMAT  (/, 16X, "*****  DS(J)  COEFFICIENTS  ALL  ZERO  **★**") 
00  TO  20 

FORMAT  (//(12*>"J  * ", I 3» 1 OX# "D-S  * 

FORMAT  C/,15X,"J  * ",  I 3,  10X,"FC0NV 
FORMAT  (//(1X,"J  = "M3>9X."RnOTR 


">£20.12)) 
a ",  E 1 5 • 8 ) 

1 "*E12.5»9X,"R00TI 


* "#E12.5>> 


OIMENSIONALIZE  the  COEFFICIENTS  Of  the  DENOMINATOR  TRANSFER 
FUNCTION 

00  15  I * 1 # NP 1 

DS(  I )*Ds(  I)*(  CLR/U>**(  I-m 
IF  (lTFCPRT.NE.1 ) GO  TO  17 
WRITE  (3>16) 

FORMAT  f //#22X»"DIMENsI0NaL  COEFFICIENTS 
WRITE  (3,8)  C(J,0SCJ))#Jb1,NR1 > 

CALL  PRNBM  (N,Ds,ROOtR,ROOtt,pCONV) 

DO  18  Js 1 , N 

IF  (ECONV(J).GT; .5E-09)  WRTTEf3,ll) 

IF C IDIMRTS.EQ.O)  GO  To  1 
WRITE  (3M9) 

FORMAT  (//»25X, "DIMENSIONAL  RflOTS") 

WRITE  <3,13)  ( ( J»R00TR( J),ROOTl ( J))# J°1 #N) 

WRITE  (3*21) 

FORMAT  (//) 


) 


J,ECONV( j) 


00001140 
00001150 
00001160 
00001170 
00001160 
00001190 
00001200 
00001210 
00001220 
00001230 
00001240 
00001250 
00001260 
00001270 
00001260 
00001290 
00001300 
0000 1 310 
00001320 
00001330 
00001340 
00001350 
00001360 
00001370 
00001380 


N«4 

NPlsN+1 

non-dimensional  X(S)  coefficients  for  towed  vehicles 
XS(5  )S(M-Zwn)*( tY"MOO)*XOFI  t + xwd*zqo*moelt  + xqd*mwd*zoeLt 

-ZOD*MWD*XOELT+XWn*(IY-MOD)*ZnELT+XOD*(M-ZWD)*MDELT 

XS(4  )s"ZW*( iY-MOD)*XDtLT"(M-ZwD)*M0*XDFLT 

♦XW*Z0D*MDELT+XW0*Z0*MDELT 

♦XQ*MWD*ZOFLT+XOO*MW*ZOELT 

-ZO*MWO*XdELT-ZqD*MW*XOELT 

♦XW*( IY-M0D)*ZDFLT-XWD*M0*7DE|  t 

♦XQ*(M-ZWD)*MOEl  T-X00*ZW*MnFLT 


00001390 
00001400 
00001 4 1C 
00001420 
00001430 
00001440 
00001450 
00001460 
000U1 4 70 
00001460 
00001490 
00001500 
GOO o 1510 


o o o o 


xs( r y-Mon )*xntLT+7w*Mo*xnn  r-(M-7hU)*MTH*xotLi 
4XZ*/0n*MLFL  T4-Xw*/<i*^uFLT  + v^U*/TH*mi;elt 

+ XTH*Mwn*7nn.  T*vO*MW*</f)FLT  + xQn*M?*70eLT 

-7TH*^W0*xnf  LT-7Q*Mw*xOFLr-/Qn*M/*XCELT 
+ X7*CIY-M(jn)*/DFlT-XW*MQ*7riFLT-Xwn*VTH*ZntLT 

♦XTH*(  M-Zwfl  )*«OFl  T-xO*ZW*^nFLr-XGn*ZZ*MOELT 
XS(2)a7Z*MQ*XOE|  WZW*M  TH*xnFL  T*X7*70*M0EL  T*Xw*ZTH*MDEL  T 
4-XTM*MW*ZnFtT*XO*MZ*ZUELT-7TH*Mw*xnELT-Z0*MZ*XDFU 
-XZ*M(J*ZOELT-XW*MTH*Z[)ELT-vTH*Zw*MnF.  I T-Xg*ZZ*MOFLT 
XS( 1 )*Z/*MTH*xOFLT  + X7*ZTH*MnE(  T + X TH*MZ*ZDtLT 
*'ZtH'*HZ*XUflT-X7*mth*/UFLT-xTw*ZZ*M[)ELT 
WRlTF  (3*2122) 

2t22  FORMAT  f//»23X*"****  x NIJMfRAtOR  ****") 

no  25  J = t » NP 1 

25  If  (XS( j).RF.n,n)  GU  tO  }} 

WRITf  (3*26) 

26  EflRMAT  ( t*  1 3X  ,"*****  XS(j1  COEFFICIENTS  ALl  ZErU  ****★") 
GO  Tn  35 

28  Format  (//(i2x»«j  = ",  i3» iox»*xs  * "»E2o.i2)i 

m 

- DIMFNSIONAL IZF  THt  COfFFtClFNTS  OF  THE  X NUMFHATnH  TRANSFER 
“ FUNCTION 

31  DO  32  1*1  * NP 1 

3?  X S ( I ) s X S C 1 )*1)CST*(  (LP/U)**r  l-i  ) ) 

IF  ( ITFCPHT.NE.i ) Go  in  33 
WRITf  (3*16) 

HKlTf  (3»2«)  ((.!*XS(J)),Ja1  ,Npl  ) 

33  CALL  PRNRM  ( N , Xs  * ROD  Th  > ROflT  I * F CONv  ) 

DO  34  I a 1 , N 

34  IF  CFC0NV(J).GT.,5E-09)  WK?TFf3*11 3 J,ECONV(j) 
IF(TniMRTS.fQ*0>  (.0  TO  3* 

WRITE  (3*t<)) 

WRITF  (3*13)  r(.|»ROOTK(J)»Rni]TI(  J))*J  = 1 ,N) 

35  WRITE  (3*21) 

36  N*4 
NPlaN+1 


00OU152O 
OOOolb JO 
00UU154O 
00O01550 
OOOo 1 560 
0000 15ZL 
OOOUl 5B0 

000O15VO 
00001600 
OOOOlfclG 
00001620 
000ul6 Jo 
0000164O 
000U1650 
OOOU1660 
00001670 
OOOU 16«0 
00001 6V0 
00001700 
OOOOIZIO 
OOOOl 720 
OOOol 730 
OOOUJ  740 

00001750 
0000 J 760 
00001770 
00001760 

ouoolzvo 
OOOOlflOo 
00001H10 
00001820 
0 0 0 o i fl  3 0 
00001840 
000O185O 
00001860 
000OI870 
00OO186O 
OUOOtPVO 


u u o 


c-  NON-niMFNSTRNAL  7(S)  COEFFICIENTS  FOR  TOWLD  VEHICLES 

c- 

7S(5  > = (M-XUD)*( T Y-MOO )*ZDFI  T + 7QD*MI)D*XDFLT  + XQL)*ZUD*MDFLT 

- ♦(M-XUD)*ZQO*mDFLT+ZUO*( lY-MQn)*XOFLT-XQD*MUn*ZDELT 
7S(A)  = -XU*(lY-MQ0)*ZnELT-rM-X|i0)*M0*ZDELT 

- +ZO*MUO*X|jELT  + Zon*MU*xOELT 

- >XQ*ZU0*M0FtT  + XQn*ZU*MDELT-XU*Z00*MDFLT  + (M-XllU)*Z0*MDFLT 

- +ZU*(  I Y-MOD)*XOFLT-ZUD*HQ*xnEl  T 

- -XQ*Mun*ZUELT-XOO*Mu*ZOELT 

ZSC  3)  = -XX*(  T Y-MOD)*ZDELT  + XII*MO*ZDE  I T-(M-XUO)*MTH*ZOELT 

- +ZTH*MUD*xnFnr+7Q*MU*xDELT+7Qn*MX*xDELT+XTH*7UD*MDELT 

- +XQ*ZU*MDELT*XOn*ZX*MoELT 

- -XX*7QD*M0ELT-Xil*Z0*Ml)ELT  + r M-xUO  ) *7TH*MDE|_  T 

- +ZX*(lY-Mgo)*XorLT-ZU*MQ*XnFLT-ZUn*MTH*XDELT 

- -XTH*MUD*ZDFLT-YQ*MU*70ELT-xQn*MX*7DELT 

ZS(2  )*XX*MO*ZnEI  T + XU*MTH*7nFLT  + ZTM*MU*XDELT  + 70*MX*XDELT 

- ♦XTH*ZIJ*MOELT  + XO*ZX*MOLLT-XX*70*MOFLT“XU*ZTH*HDFLT 

. -ZX*MG*XDELT-7U*MTH*X0ElT-YTH*MU*ZnELT-XQ*MX*Z0ELT 

ZS( 1 )=XX*MTH*7DFLT+ZTh*MX*XDEl  T+XTH*ZX*MDELT 

- -XX*ZTH*MnF|_T-Zy*MTH*xDELT-XTW*MX*7DELT 
write  (3*3so) 

350  format  (//»23x»*****  l numfratOR  ****") 

DO  39  Js 1 » NP t 

39  IF  (ZSCj).NE.O.n)  GO  TO  45 
WRITE  (3*40) 

40  FORMAT  (/» 1 2X. ******  ZS(JT  COfFFICTENTS  ALL  7&R0  ♦****"> 

GO  TO  49 

4?  FORMAT  (//(i?X,"J  = M3»lftX»"ZS  = n»E20.l2)> 

C- 

OIMENSIONALIZf  the  coefficients  OF  the  z nUmfHATOH  TRANSFER 
function 

45  DO  46  I s 1 * NP i 

4 6 ZS( I )*ZS( I )*OCST*( (LR/U)**M -i ) ) 

IF  ( ITFCPRT.NE.1  ) GU  TO  47 
WRITE  (3*16) 

WRITE  (3*4?)  <(.|»ZS(J))*Jsi,Npl) 

47  CALL  PRNBM  (N»ZS»R00TK#R0nTl # FCO N V ) 


00001900 
00001910 
00001920 
00001930 
00001940 
00001950 
00001960 
00001970 
00001960 
00001990 
000O2000 
00002010 
000O2020 
00002030 
00002040 
000O2C5C 
0000206O 
00002070 
00002080 
00002090 
000u2 1 00 
00002110 
00002120 
000O2 1 30 
00002140 
00002i 50 
000U21 60 
000021 70 
00002160 
00002190 
00002200 
OOOU22  lu 
00002220 
000022 30 
00002240 
00002250 
00002260 
00002270 


no  Js|,N 

45  IF  (F CONV( J ) .OT . .5F-09 1 WRTTF.f3»11)  J>ECUNV(.I) 

T F ( I n I M R T s . F Q . 0 r,  n I ij  5 0 
WR  J TF  (3.19) 

WHITE  n>13)  ( ( l,  HtlOTKC  J ) , RTOt  1 ( J)  ) » J=  I » N ) 

49  WRJ  TF  ( J>21) 

50  N = 4 

NP1 «N+ 1 

N C1N  ”0  T RE  MS  T ON  AL  US)  COEFftcIfNTS  F(JR  TOWLU  VEHICLES 

TS(5)  = (M"XUn)  + (M"Zwn)*MOElT  + XwO*Mlin*Z|)FlT  + Zun*MwO*X|)FLT 

4(M-XUn)*HWO*7OrLT-Xw0*ZUn*wOrLT*(M-ZMn)*HU0*AOFU 

TS(4)*-XU*(M-?wn)*M0ELT-CM-xUnWw*MnELT 

+ XW*Mun*/DFLT  + XHl)*Mu*ZnFLT  + /tUMwO*XOFLT  + /UU*Mrt*XOLLT 

-XU*Mwn*/L)ELr+(w-XlJ0)*MW*7nFLT-XW*7Ul)*M|)FLT-Xwf)*/U*RUFLl 

-ZW*mUD*XoflT+(m-ZW0)*MU*XOFLT 

TS{3)  = -XX*(M-7Wn)*MOELT  + <ll  + ZW*MUE|T-fM-XUL)*7Z*M0t.LT 

♦ X/*MUo*ZoF|T  + Xw*MU*7l)F;iT  + ywn*MX*/nELT 
+ ZX*MWn*X[)ELT  + Zii*MW*X|.iELr  + 7i'l)*MZ*xntLT 
”XX*Mwn*ZuFLT"<n*Mw*7()ELT  + rM"yUD)*MZ*ZnELT 
-XZ*7Un*M()EL  T-Xw*/U*wnFLT-YWU*Hx*vntLI 
•ZZ*MUn*XuELT’,Zw*MU*xnELT  + rA,-7WD>*MX*xnELT 

TS(?)  = XX*ZW*MnEl  T + XU*ZZ*^nn  r + XZ*vil*Z0FLT  + Xw*MX*7L)EL  T 

♦ ZX*MW*xOELT  + ZU*MZ*XOFLT-XX*Mw*ZnFLT-XlJ*MZ*ZntLT 
-XZ*ZU*MDtl.T"XW*7X*MDELT-77*MII*XnELT-/W*MX*XnLLT 
TSC  1 )=XX*/Z*MOE|  T + XZ*RX*ZOF|_  T+ZX*RZ*XDELT 
-XX*M7*Zr>fcLT-XZ*7X*MOElT-77*My*XOFlT 

WRlTC  (3>5?) 

5?  FORMAT  (//»?3X»”****  j NUMFRAtHR  ***★") 

on  53  J=l»NPl 

53  IF  (TSC J)  .Nj  .0.0)  GO  lO  59 
WHITF  <3»54) 

5 A FORMAT  (/, J 3X, ******  TSCJ3  COEFFICIENTS  ALL  ZERO  *****") 
GO  Til  ft  3 

56  FORMAT  (//(i?X,"J  = "»l3»iny»«TS  = %E70.12)> 

01 MFNS  l ONAL  I ZF  t HE  COEFFICIENTS  OF  THE  J NUMFhATUK  TRANTER 


OOOu2?cC 
0 0 0 u 2 2 V 0 
000U23OO 
000 1;  2310 
000  0 231-0 
000023  JO 
000 w 2340 
000U2350 
00002360 
000O237O 
00002300 
00002390 
000u2400 
000024  10 
00UU2420 
00 002430 
00002440 
00002450 
00002460 
000024  70 
00002460 
00002490 
00002500 
00002510 
00002520 
00002530 
00002540 
00002550 
000o2560 
OOOU2570 
00002560 
000O2590 
00002600 
00007610 
00002620 
00002630 
0 0 0 0 2 6 4 0 
00002650 


C-10 


C" 

FUNCTION 

00002660 

c- 

000026  7 0 

59 

00  60  I s t * NR  1 

00002660 

60 

TS(I)*TS(I)*((LR/U)**(I-1)> 

00002690 

IF  ( ITFCPNT.NE.1 ) GO  TO  61 

00002700 

WRITE  (3*16) 

00002710 

WRITE  (3*56)  C(J*TS(J)>,J*1 ,NPl) 

00002720 

61 

CALL  PRNBM  ( N , T S , ROOTR , ROflT  T » fCONV  ) 

00002730 

no  62  I = 1 * N 

00002740 

6? 

IF  (ECONV( J).GTl.5E-09)  Wr  t tE  r 3 * 1 1 ) J*ECONV(j) 

00002750 

IF( lDlNRTS.EQ*0)  GO  TO  63 

00002760 

WRITE  (3*19) 

00002770 

WRITE  (3»  13)(( J,ROOTH( J)*ROOTr( J) )» J = 1 *N) 

00002780 

6 3 

cont i nuf 

00002790 

C- 

00002000 

C- 

00002010 

c- 

00002020 

OTOEl (6)=TS(b) 

000020  JO 

0TDE1 (5)“TS(ft ) 

00002040 

OTOEl  (A  )=>TS(3) 

OOOU205O 

otoe i ( 3 )=ts( 2 ) 

00002060 

OTOEl (2)*TS( 1 ) 

000O28  70 

0TDF1 (1 )*0.0 

00002000 

N*5)NlO=N 

OOOU209O 

CALL  PRNflM(N#OTnEl»OTDElR,DTDFlI»ECONV) 

00002900 

WRITE (3* 3201  )(0T0E1R( J10)»0TDf1 I( J10)» J10  = l *N) 

00002910 

3201 

FORNAT(/»"ZERn$  OF  TD/E i " , /, 4 ( F9 . A , f 9 . A ) ) 

00002920 

Ns4 1 N 1 2SN 

00002930 

DO  2000  11*1,5 

00002940 

0TE2(  11  ) = TS( 11  ) 

00002950 

2000 

CONTINUE 

00002960 

CALL  PRN0McN,nTF?.OTE?R,OTF?I.ECONv) 

00002970 

WRI TE( 3, 3202)(0TE?R( Jl 2 ) ,OTfc 2t ( J1 2 ) * Jl 2*1 ,N) 

00002900 

3202 

F0RNAT(/,H7FRns  OF  T /fc 2" * / . A ( r9  . A , F9 . 4 ) ) 

00002990 

0ZDE3(6)=ZS(5) 

000U3000 

0ZDE3(5)sZS(A)-TS(5)*U0 

00003010 

OZOF  3(4  )=ZS( 3)-TS(4 )*U0 

00003020 

OZDE3(3)*ZS(2)-tS(3)*UO 

00003030 

0/0E3(?)  = ZS(  t )-TS(  2)*Ud 

OOOuJCmm 

02DF  3(  1 ) = - T S C 1 )*0(l 

OCOi-  3050 

N = s ; N ] 4 

00003C0C 

CALL  PRNRM(N»nZnE3#07l)E3W*n/Ur3I*ECUNV) 

00  U 03070 

WHlTF(3#3203U07nE3H(jt/|).n70F3I(JlA)*Jt4=l»N> 

00003060 

3203 

FORMAT  ( /»"ZF  KnS  OF  /R/E3  AMR  / //U"  * / > 9 ( F9 . 9 * F V . A ) ) 

000U30*>  0 

29^7 

WRITE { 3*2998) 

00003100 

299  fl 

FORMAT  ("ENTER  KTnriRG*OELKTn»KTl)F  IN"*/) 

000031  10 

RFAD(3#/)KT0nRG,0ELKT0*KTnFTN 

OOCu  3 1 *0 

if  (OFLKrn.FO.o)  r,o  to  99 

000u3  1 30 

NGAIN=(KllJFIR-KTOORG)/OELKTn-M 

000U31 «0 

K TOsKTOORg 

00003150 

00  3001  J[)=l  * NG A I N 

000 U3190 

RT0F1 ( 7 ) = US( 7) 

OOOu  3 1 70 

RTOEl  (6)  = 1)S(6)-*To*TS(5) 

OOOu 3 1 8o 

RT0El(5)  = ns(5)-w'T0*TS(A) 

0001/3190 

RTOF  1 (4)S0S(9  )“*TD*T.S(  3) 

00Cu3200 

RTDEH3)  = U5(  3)-kTO*TS(2) 

000o321o 

o 

RTOEl  (2)  = L)5>(?)-kTD*TS(  1 ) 

00003220 

1 

RTOE t ( 1 ) = 0S( 1 ) 

000032  Jo 

h-* 

N = 6 

000O329C 

CALL  PHNRM(N#RTr)El  *RO[jTR*RnoT  t»EC(1NV) 

00003250 

00  3006  J=1*N 

000U326O 

IF  (FCONV(J)  ,f,T.  .5t*09)  WPTTf  (3*110)  J*LCCnV(J) 

000O327O 

3006 

CONT  I MIE 

000 U 3200 

WRlTF(3»3002)KTn 

000O32V0 

3002 

FORMATCFfl.2) 

00003300 

WRITF(  3*3  00  3)  ( R00TR C J ) , ROOT  I ( J ) » J* 1 *N) 

000u3  3 Im 

3003 

F0RMAT(A(F9. A »FO.A  ) ) 

00003320 

3001 

KTO=KTO+OELKTn 

0C0O333O 

WRITF(3#300A) 

000033«0 

300/1 

FORmAT("DO  YOU  WANT  TU  CONTINUE  «tO  R.  LOCUS” 1 

0G0U3350 

REAR ( 3*/  )NVAL 

00003390 

IF  (NVAl.FQ.1)  on  TO  2997 

00003370 

3016 

WRITE  ( 3*3005) 

OOOU3380 

3005 

F0RMAT(”ENTFR  KTO") 

00003390 

R E A 0 ( 3*/)KT0 

0000  3900 

3007 

WRITF(3»3O0H) 

00003910 

C-12 


3008 

FORMAT ("ENJFK  KtORG»0EI kt,ktf  ?N") 

0000342U 

REA0(3>/)KT0RG,nELKT#KTFlN 

00003A3U 

IF(DELKT.EO.O)  00  TO  99 

00003440 

NGAIN*(KTf IN-KTnRGJ/OELKT+i 

00003450 

KT*KTORG 

00003460 

00  3012  JD=1»NGaIN 

00003470 

RTE2(7)=DS(7) 

00003480 

RTE2(6)*DSC6)"KtO*TS(5) 

00003490 

RTE2(5)rDS(^)-KTn*TS(9)+KT*TSf5) 

00003500 

RTE2(4)=0S(«)-KT0*TS(3>+KT*TSf 9) 

00003510 

RTE?(3)*nS(3)-KTn*TS(p)+KT*TSr 3) 

00003520 

RTE2(2  )sOS(?)-KTO*TS( 1 > + KT*TSr 2) 

00003530 

RTE2C 1 )*0S( i ) + KT *TS( 1 ) 

0000354C 

N = 6 

00003550 

CALL  PRNBM(N#RTF?*ROOTR*RfinTI  • ECON v ) 

00003560 

00  3009  Jsl,N 

000035  7 t 

IFCECONv(J)  .GT;  .5E-09)  WRTTF  (3»110) 

J»  ECONV ( j ) 

00003560 

3009 

continue 

00003590 

WRITE(3»3010)KT  . 

00003600 

3010 

F0RMAT(F8.2) 

000036  1C 

WRITE(3>301 1 )((RnOTR(J),RnnTlrJ)# J=1#N)) 

00003620 

3011 

F0RMAT(4(F9.4»FR.4)  ) 

00003630 

3012 

KT*KT+OELKT 

00003640 

00003650 

NRITE(3#30i 3)KTp 

00003660 

3013 

F0RMAT("00  YOU  WANT  NEW  KT0,0xN0# i*ent 

,2*ENTAC0mP>KT0 

Nnw=",F8,2)  00003670 

REAO( 3»/  )NVAL 

00003680 

IF  (NVAL'EO. 1 )Gn  TO  3016)  TF  fNVAL.EO. 

?)  GO  TO  2997 

00003690 

WRITE(3>301A) 

00003/00 

3019 

FORMAT ("DU  YOU  WANT  TO  CONTINUE  KT  R. 

LOCUS") 

00003710 

REA0(3^/)nVAL 

000O372C 

IF  (NVAL  .EO.  1)  GO  TO  3007 

00003730 

3017 

WRITE(3»3015> 

00003740 

3015 

FORMAT ( ♦'ENTER  KT") 

0000375C 

REAO( 3»/)KT 

00003760 

3018 

WRlTE(3»30l9) 

0000377c 

3019 

FORMAT("ENTER  KZ00RG,DELK7n,KZDFlN«) 

000O378U 

READ( 3#/)KZ00RG»0ELKZD'KZnFTN 

000U3790 

C-13 


30?o 

30?  I 
30?? 

3009 
30?  3 

3103 

30?  4 
3025 

30?6 

309fl 


IF(PF'LK/n.FO.O)  GU  TG  99 

NGAlN=f  K7l)FlN-K7nUK(,  )/nF  LK;n+i 

K7n=K700HG 

on  30??  ju=i*ngain 

HZ0F3(7  ) = I)S(  n 

R7nF3(M*l,S(6)-KTU*lS(5)  + (w/0/RAl)tAN)*/S(b) 

R/DF'.3f  5 )*0S(  *i  )-kT(»*TS(  0 ) + KT*T^(5  )•»(  K?I)/RADI  An  )*f  ZS(  A )-T^(5  )*tu  ) 
RZr)F3(A)*OS(A)"KTU*TS(3)+KT*T*(A)  + (K7D/HAUlAN)*fZS(3)"T^(A)*Uu) 

RZOF  3 ( 3)=DS(  3)-KT|)*TS(2  ) + KT*Ts(  3 ) + (*ZU/RAUl  AN  >*f  ZS(  2 >“T<;(  3 )*IJU  ) 
R/DE3f?)*0Sf2)"Kln*TS(1)»KT*r'(2)  + rKZD/RAl)IAN>*r/S(l)-T$(?)*UC) 
RZDF3C1 )*0S( 1 )+*T*TS( I )+(K/n/RADIAN)*(“TS(l>*uO) 

N = ft 

call  PRN«M(N»RznF3»Rni'TR»RnnTT»F.CnNV) 

0 G 30?0  J=1,N 

IF  (FCGNV(J)  .Gt.  .5F-09)  W W I T E (3*110)  J*LCnNV(J> 

CONTINUE  JWRI Tr( 3* 31  1 0 )K7n 
WRITE  (3»3n?l)(rR0mR(J).RnuTT(J)*J=l*N)) 

FORMAT  (4(F°.4,F9.4) ) 

K?n  = KZD+l)FLK7l) 

HR  I TF ( 3*  3099  )XTn 

FURMAT("nU  YOU  WANT  NEW  KTO.  kTU  NOW  ="#F8.2> 

RF  An ( 3 * / >NVAL 

IF  (NVAl.FQ.1)  r,l)  T(1  3OI6J  IF  (NVAI.EC.?)  GO  1 0 ?997 
WRITEC  3*  30?3>KI 

FORMAT  ( wnn  YOU  WANT  NfcW  KT.  K T NOW  ="*F8.2) 

REACT  3*/  )NVAL 

IF  (NVAL.EO.l)  0,0  TO  30  1 7 5 T F f N V A L .EC.?)  GO  TO  3007 
WRITF(3f3l03) 

FORMAT ("00  Y 0 1 1 want  TO  CONTINUE  K 7 0 r.  LOCUS") 

RF  AOC  3*/)NVAL 

IF  (NVAl  .EO  . 1 ) r,0  TO  30  1 « 

RRITE(3*30?5) 
format  ("Enter  K7I)") 

REAfH  3'/)KZn 
WRITEf  3*  3090  ) 

FORMAT ("ENtFp  wzORG.OFLK/.KZrlN") 

RFAf)(  3*/)KZ0RC..nFLKZ.KZFlN 
IF  (0FLK7  .F  Q.O  ) r,0  TO  99 


0 0 0 •<  3 8 o v, 

OCOo38  U 
00UU382G 
000038 30 
OOOu  38  AC 
000038b0 
00003860 
00003870 
00003880 
00003890 
000U3900 
00003910 
000u3920 
0COO393O 
OOOO  39 AO 
0COU3950 
00 003960 
00003970 
00003980 
00003990 
00004000 
00004010 
00UOA02O 
00004030 
000O4C40 
00004050 
000o406O 
00004070 
00004080 
0O0OA0V0 
00004 100 
000O4  1 1 0 
00004 1 20 
000O4 1 30 
00004 1 40 
000u4 1 bo 
00004 1 60 
00004170 


C-14 


NG A I N* ( K ZF I N-KZnRGJ/OELKZ  + l 
K2*KZORG 

00  3029  JD=1#NGaIN 
RZZ0!8)*0S! 7) 

RZZO! 7 )*0S! 6)-KTD*TS!5)+Kzn*Zs!5) 

RZZ0!6)*DS!5)-KTD*TS!4)+KT*TS!5)+KZ0*!ZS! 4)-TS!5)*U0)-K7*ZS!5) 
RZZOf  5 )*0S(4  )-KT0*TS(3)-»KT*TSM)  + KZD*(ZSf  3)-TS(fl)*U0)-K7*(ZS(4) 

- -TS(5)*U0) 

RZZOM>  = OS(3UKT*TS(3>+KZD*f  Zs ! 2 > -TS ! 3 > *UQ >-KZ * ! ZS ! 3 )«T* ! 4 > *U0 ) 
• ■KTO*TS(?) 

RZZ0C3)*DS{7)+KT*TS(?)+KZ0*fZ5(l)"TS(2)*U0)"KZ*fZS(2)"Ts(3)*U0) 

- -KTD*TS(i) 

RZZ0(2)s0S(1 )+KT*TS( ! )-KZD* T S r 1 ) *UO“KZ* ! ZS ! 1 ) -TS ! 2 > *U0 ) 

RZZo( 1 ) = -KZ*(-t^( i )*U0> 

N*7 

CALL  PRNBH(N,RZ7O»R00TR,ROnTI .ECONy) 

00  3027  J*1,N 

IF  (ECONV(J)  . GT . .5E-09>  wRItE  C 3 # 1 1 0 ) J#ECnNVfJ) 

3027  CONTINUE  I WR I Tf ( 3* 3 1 1 0 )K7 
GAlN«KZ*ZS(5>/nS(5) 

WRlTEt3#3250)GAIN 
3250  FORMAT("GaIN  =",F8.4) 

WRITE  (3#3O28)(fR00TRc J)*ROOTt( J)*J*1#N)) 

3028  FORMAT  ( 4 ( F9 . 4 , F9 . 4 ) ) 

3029  Kz*KZ+DELKZ 
WRITE! 3»3099>KTn 
READ(3#/)NVAL 

IF  (NVAL.EQ.n  GO  TO  3016  7 T F rNVAt.EQ.2.)  GO  To  2997 
WRITE!  3*  3023 )KT 
REAO! 3'/  )NVAL 

IF  INVAL.EO.1)  GO  TO  30 1 7 1 t F f NVAL  .EQ.2)  GO  TO  3007 
WRlTF!3,3032)KZn 

3032  FORMAT ! "DO  YOU  WANT  NEW  K70,K7D  NOW  s",F8.4) 

REAO! 3p/ >NVAL 

IF  !NVAL  .E0.1)  GO  To  3024  1 I F ! N V Al . EO . 2 ) GO  TO  3018 
WRITE!3#3033> 

3033  FORMAT ! **00  YOU  WANT  To  CONTINUE  KZ  R.  LOCUS'*) 

READ! 3*/)NVAl 


00004180 

00004190 

00004200 

00004210 

00004220 

00004230 

00004240 

00004250 

00004260 

00004270 

00004280 

00004290 

00004300 

00004310 

00004320 

00004330 

00004340 

00004350 

00004360 

00004370 

00004380 

00004390 

00004400 

00004410 

00004420 

00004430 

00004440 

00004450 

00004460 

00004470 

00004460 

00004490 

00004500 

000U45  10 

00004520 

000O453C 

0000454U 

00004550 


IF  (NVAL.LO.  1 > Ofl  Til  30?6 

000U456O 

000045/0 

*HTTFC  3,9l)On> 

000 u 4500 

9000 

FF1R M A T C ”Ofj  YOU  wA.\T  A TJMfpi  f « ) 

000U45V0 

Rf  A D C 3,  / >NVAL 

0C0u460c 

TF(NVAL.CC.O)  Gn  Tn  0*; 

000046  10 
00UO462O 

c- 

OOOU46  30 

wk  I TF  c a , Anon  ) (tHLLM)»Is1,1i  ) 

00004640 

c* 

000o46bO 

c- 

STANDARD  T F S T VaLUES  USFO  rpR  THFSF  UMFPL1S 

00004660 

I F s 1 

TOEL=0 . 1 

000046  7 ^ 

00004600 

TMAx=?0 . 

00004690 

RT  IMF  =0 . 

OOOO47OO 

ptimf=io. 

000O47 10 

*=0 

0000472U 

I PL  0 T = 1 

00004/30 

0 

1 

TwRlTt  =0 

0QC0474O 

M 

Ln 

00004750 

WRITF(A#9003  MF.  TOLL  *1  PAX,  Rj  ime»pttme»w,iplutm write 

00004760 

9003 

rnRMAT(Il»1H»»FS.3»lH»#Ffl.1.lH#>F10,5»lH#»F10.S*lH»# 

00004770 

m 

FlO.S»lH»»TS»lH,,[b»?H»*) 

00004  700 

86 

WRITFC  3 » 900  1 ) 

00004790 

9001 

FPRPAT(mLMFR  K t 0 # K T * k Z 0 > K 7 , G a M P ” ) 

00004600 

RFAn(3»/)KTn»t<T,K/n»'<^,GAwP 

00004010 

WRITFC 3,900?) 

00004620 

900? 

FORMAT  (**  T I M F P L T FOR  WRlCw  IOOpT". 

000O4P30 

- 

ENTER  1=lST>  ?s?NH,  3=3»n»  4=4TW") 

00004640 

RE  ADC  3»/  )NVAL 

000o4HbO 

IFCNVAL.F «.?)  Gn  TO  PjOO 

00004660 

IFCM/AL.EU.3)  GO  10  9101 

000O4H  70 

IF (NVAL . F«  . A ) Gn  TO  910? 

00004800 

GAU'*GAmP*CT.S(5)/0SC  7)) 

00004890 

WRlTFC  A»900« )NlO»GAlN 

00004900 

9004 

FORMAT!  I 1 * 1 P » #F1^,b#?h,*) 

00004910 

WRlTFCA,900S)C(OTl)ElH(n)*nT0FlICIl))/ll  = WNl0) 

00004920 

900*7 

FORMAT  ( AC  F 1 ? . 5 , 1 H , ) , 1 »i  / ) 

00004930 

C-16 


GO  TO  9103 

9100  GAINaGAMP*(TS(5l/DS(7)) 

WRITF(4#9006)N1?,GAIN 

9006  F0RMATCI1MH'»Fi5.5'2H'*) 
WRITE(4,9007)((nTE2R(l2),nTE2T<l2)),I2«l,N12) 

9007  F0RMAT(A(F1?.5»1H#  )#1H/) 

GO  TO  9103 

9101  GAIN*GAMP*(ZS(5l/0S(7) ) 

WRlTE(4#9008)Nla,GAIN 

9008  F0RMAT(IWlH»#Fl5.5#2H**> 

HRITE(4#9009)( <nZ0E3«( l3)»n70F3I( 13))# I3*1#Ni4) 

9009  F0RMAT(4(F1?.5MH#  )*1H/) 

9103  RZDE3(7)aDSC7) 

RZDE3(6)=DS(6)-kTD*TS(5)*K70*7S(5) 

RZ0E3(5>s0S(5)-kTD*TSC A)+KT*Tc(5HkZD*(ZS(4)-TS(5)*U0) 
RZ0E3(4)s0Scfl)-KT0*TSc3)  + KT*T<;(4)  + KZ0*(ZS(3)-TSf4)*U0) 
RZ0E3C3)=0S(3)+KT*TS(3)+K7D*(7S(2)-TS(3)*U0)-KT0*TS(2) 
RZ0E3(2)a0S(2)*KT*TS(?UKZD*(7S(  1 )-T.S(?)*UO)-KTD*TS(  1 ) 

RZ0E3 ( 1 )»OSf 1 )*KT*TS( 11-K70*TS( 1 )*U0 

N*6 

CALL  PRNRM(N»RZnE3»R00TR#Rn0TT*EC0NV ) 

00  9010  J* 1 » N 

IF  (ECONVCJ)  .GT.  .5E-09)  WRITE  (3#110)  J^ECONVCJ) 

9010  CONTINUE 
HRlTE(«#901 1 ) N 

90n  FORMAT ( 1 1 » 2H>  * ) 

HRITE(4/901?)((ROOTR(J6)#ROOTt(J6  ))# J6*t >N) 

9012  FORMAT(4(F12.5mHOMH/) 

GO  TO  77 

9102  GAlN*GAMP*((-KZ*ZS(5))/DSf 7)  ) 

WRlTE(4>9013)NlMGAlN 

9013  FORMATC J1,1H#,F15.5,2h>*) 

WRlTE(4#90l4)((nZ0E3RcJ7),n70F3I(  J7))#  J7*1#N1<») 

90ia  F0RHAT(4(Fl?.4#lH#  )#1H/) 

RZZ0f8)sDS(7> 

RZZ0(7  )bDS(6)-KTD*TS(5  ) + KZ0*Z<;(5) 

RZZ0(6)=DS(5)-KTD*TS(4)+KT*TSf 5)+K70*(ZS(4)-TS(8)*U0)-K7*ZS(5) 


00004940 

00004950 

00004960 

00004970 

00004960 

00004990 

00005000 

00005010 

00005020 

00005030 

00005040 

00005050 

00005060 

00005070 

00005080 

00005090 

00005100 

00005110 

00005120 

00005130 

00005140 

00005150 

00005160 

00005170 

00005160 

00005190 

00005200 

00005210 

00005220 

00005230 

00005240 

00005250 

00005260 

00005270 

000052^0 

00005290 

00005300 

00005310 


C-17 


RZ70f5)=nSrAl-KTn*TSM)+1<T*TSrA)+K70*(7SC3>-T>(A)*UC)-K7*(/S(<O 

-TS<5)*UU) 

R/7n(a)=nsf3)  + t<T*TS(n*'<zn*f^^(?)-TS(i)*uu)-K/*f/.sc3)"i«;(fl)*oL) 

- -<Tn*TS(?) 

9Z70(l)  = ns(?)*KT*T5(7)  + K7n*f/<;Cl)-Tb(?)*lilJ)-K/j*c7S(2)-T<;(3)*Utj) 

- - K 7 n * T S ( M 

Rzzo(?)  = nsn  )+kt*tsm  )-K7n*rsri  )*Hn-Kz*(Zstn-Ts(?)*un) 

R/ZO(  1 )r-K7*(-Tf,(  J )*tiO) 

N = 7 

CALL  PRNRF(M>R/70»R0nTR,RnPTI . ECON'O 
no  9015  .J=1,N 

IF  (FCONV/fj)  .Gt.  .5F-09)  w^ItE  0*110)  J^ECO^VfJ) 

9015  CUNTINUF 

WRITF  (A,9()16)N 
90J6  FORMAT  (Tl*?H**) 

WWITF(9,90-17)C  (ROUTR(  j9).RnnTi  ( J9)),  J9=l  , N) 

9017  fO«mAT (4(F 1 2.5, 1 H,  >,  1H/ > 

77  WRJTFC  7 » °0 i R ) 

90 1 fl  FpRvAT("OL)  YOU  wAM  AnOTHFR  TtmEP|T"> 

RF  A0C3»/  ) N V AL 
IF(nvAl.F(j.1)  On  TO  AH 
99  CONTINUf 

C“ 

c-  NOW  WRITE  PROGRAM  COSI  INFORMATION 

c- 

IT1=TTm€ (2)/60.nT  XMl=O.OSMTi 
1 1 ? = T | Mp  c 3)/60,n;  xm2*0.0t*iT? 

I T 3=  T IME(7 )/60,0J  XM3=0.0i*TTt 
Xha=XMi +XMP+XM3 

WRITF( 3»51T  IT1,XM1,T|2,xm?*It3>XP3*XMA 
SI  FORMAT  </."  PROCESSOR  Tl^p  = " » I 5 * **  St C " * 5 X > " fcn * F 6 . 2 * / 

* " I/O  TTMF  = "*15,M  AFC"»5X,"i",F6.2>/ 

- " PRORATE  0 TIME  = " ' l S * " SF C M » 5X » " * " » F 6 . 2 • / 

- ?0X.  "TOTAL  COST  " , " t " » F 6 . ? ) 

STOPJF^O 

SURROUTIM  PRNIRm  (N#A»U#V»FfUN'V) 

OIMENSION  A(8),n(fl)»Vffl),FClTNv/(8).M(8)/H(fl)^CCfl) 

icount=i 


G00o53*:m 
00Uw5  3 3o 
COOoS  3A0 
0000535^ 
000O5360 
000 u 53/0 
000O5380 
00005390 
OCGuS AOo 
000O5A  10 
00005A20 
OOOo5A30 
OOOU5AAO 
OOU u5  A 5 0 
00005  A60 
00005 A / 0 
OOOU5 AdO 
OOOusa Vt 
000 0 5500 
00005510 
000u55<!0 
000 OSS  it 
OOOU55AO 
00005550 
00005560 
000055/0 
00005580 
000o5590 

ooouseoo 

00005610 
000u562o 
00005630 
000o56 AO 
00005650 
00005660 
000056/0 
00005680 
00005690 


r*  d o o o o o n o o n n 


EFIX*.5E*09 

00005700 

CONv  = 1 , E"  35 

00005710 

NC*N* 1 

00005720 

c* 

00005730 

c- 

send  coefficients  to  reoucfo  coefficient  storage 

00005740 

C" 

00005750 

00  1 1*1 » NO 

00005760 

ECONV ( I )*0.0 

00005770 

1 

H( I )*A ( I ) 

00005780 

C* 

00005790 

c- 

Initialize  guests  and  set 

reversal  Indicator  normal 

00005800 

C" 

00005810 

p*o. 

00005820 

0*0.0 

00005830 

RsO . 

00005840 

I REV* 1 

00005850 

c- 

00005860 

c- 

SCALING  To  BE  OnNE  AT  THIS 

POINT  and  REMOVE  ALL  ZERO  ROpTS 

00005870 

c- 

00005880 

2 

IFCH(NC))  4 » 3 » 4 

00005690 

3 

NC*NC-1 

00005900 

V(Nc)*0.0 

00005910 

U(NC)*0.0 

00005920 

GO  TO  2 

00005930 

4 

IFCH(l))  7 » 5 » 7 

00005940 

5 

NC*NC*1 

00005950 

V(NC)*0. 

00005960 

U(NC)aO. 

00005970 

00  6 I ■ 1 * NC 

00005980 

6 

H ( I ) = H(  I + l ) 

00005990 

GO  TO  A 

GOO06OOO 

c- 

00006010 

c- 

TFST  FOR  VARIOUS  DEGREES 

00006020 

c- 

0000603U 

7 

IF( ICOUnT.lT.?)  GO  TO  8 

00006040 

econvc  icount-1  )*e: 

00006050 

8 

I COUNT* I COUNT* 1 

00006060 

9 

IF(NC-l)  10*50/10 

00006070 

C-19 


in 

IFCNC-2)  1 ? , 1 1 » 1 2 

ooootoeci 

1 1 

H = -N( 1 )/H( p ) 

ooou6oyv> 

GO  TO  37 

000u6 1 uO 

12 

IFCNC-3)  10#13*i  4 

0C0O6 1 1^ 

1 3 

P = H( ? )/H( J ) 

000U6 1 20 

Q = HC 1 )/H(  3 ) 

00006 1 30 

GO  TD  0? 

00006 1 AO 

000U6 1 bo 

TEST  TO  REVERSE  COEFFICIENTS  AND  HO 

SO 

IF  Ttsl  SUCCEEDS 

00006160 

00  006 1 Fo 

l « 

IF(ABScM(NC-n/H(NC))-A8SfM(9)/HMJ)) 

15,21,21 

00006 1 80 

15 

IHFV  = -IRF  v 

OOOU6 1 VO 

m=nc/2 

000O620O 

no  i a i=i »m 

000062  10 

NL  = NC  + 1 - I 

000O622U 

F=H(  Nl.  ) 

00006230 

H(NL  )=HC I ) 

00006240 

1 A 

H( I )=F 

00006250 

IF  (Q ) 15* 1 7*  1 « 

000 0 6260 

1 7 

P = 0. 

OOOU62  f 0 

GO  TO  19 

00006280 

15 

P = P/Q 

00OO62V0 

fl=1 ,/Q 

00UO6300 

19 

I F C H ) 20*21 »20 

000O63  10 

20 

R=1 ./R 

00006  320 

000U633O 

NEWTON*  CALCULATE  F(«)  ANO  TEsT  FOR 

ROOT 

00006340 

00006350 

?1 

E=FFIX 

000O6360 

R(NC ) = H( NC  ) 

000O63  /O 

C(NC  )=H(NC  ) 

000 06380 

R ( NC ♦ 1 )=0. 

00006  3 VO 

C ( NC  + 1 ) = 0. 

00006400 

NP  = NC-  1 

0000641O 

22 

DO  .35  J=1*1000 

000 06420 

00  23  T 1 = 1 * N P 

00Uu64  30 

t=NC- J 1 

0 0 0 o 6 4 4 0 

8 ( I )=H(  I ) + R * B ( U1) 

000O6450 

<“><■>  o o o o ooo 


23 

C C I ) = B(  I ) +R*C ( 1 4 1 ) 

IFCABSCBC 1 )/HC 1 ) )“E) 

37#37*24 

24 

IF(C(2))  26  # 25 # 26 

25 

R*R  + 1 , 

GO  TO  27 

26 

R*R-B(1 )/C(2) 

MAKE  A BAIRSTOW  REDUCTION  AND  CORRECT 

27 

00  28  1 1 * 1 # NP 

I *NC“  1 1 

B ( I )*H( I )-P*B( I ♦ 1 )-0 

*BC  !♦?) 

28 

C(  I )*B(  I )-P*CC  U1  )-0 

*C(  1*2) 

TEST  FOR  CONVERGENCE 

OF  BATRStOW  proces 

IF(H(2))  30  # 29  # 30 

29 

IFCABS(B(2)/HC1 ) )-E) 

3 1 # 3 1 » 32 

30 

IF(ABS(B(2)/H(21)-E) 

3 1 # 3 1 . 32 

31 

IF( ABSCB( 1 )/H( 1 ) )-E) 

42#  42#  .32 

32 

CBARsC ( 2 )-B( 2 ) 

0«C(3)**2"CBAR*C(4) 

I F C 0 > 34#  33#  34 

33 

P«P-?, 

Q»Q*(0*  1 , ) 

GO  TO  35 

34 

P*P+(8(2)*C( 3>-R( 1 )*i 

C(4))/n 

Q«Q4(-B(2)*CBAfuB(  i ) 

*CC3))/0 

35  CONTINUE 
E*E# 1 0 t 

IF(E-CONV)  22'22>36 


36  CON V»E 
GO  TO  62 

LINEAR,  COMPuTr  AND  STORr  LtNEAR  HOOTS 

37  NCsNC-1 
V ( NC ) sO  . 


00006460 
00006470 
00006460 
00006490 
00006500 
00006510 
00006520 
00006530 
00006540 
00006550 
00006560 
00006570 
00006560 
00006590 
00006600 
00006610 
00006620 
00006630 
00006640 
00006650 
00006660 
00006670 
00006660 
00006690 
00006700 
00006710 
00006720 
00006730 
000067  40 
00006750 
00006760 
00006770 
O00U6780 
000U679C 
00006^00 
00006610 
00006820 
00006630 


c- 

c- 

c- 


c- 

c- 

c- 


c- 

c- 

c- 


IFCIKEV)  3«.J9,i9 

38  U(NC  > = 1 ,/K 
GO  TO  40 

39  U(*C)=R 

4 0 no  /ii  t=i»nc 

41  H ( I ) s H ( I ♦ 1 ) 

GU  To  7 

CUaCHATiC.  SOL'/F  ft  U A It  R A T if  Awl)  STnRE 

4?  N C = N C " ? 

IF(IRfV)  4 i,  4 4,  *4 

43  QP=1 . /Q 
PP=P/fC*?.o) 

GO  TO  45 

44  QP=C 

pp=p/?,n 

45  F=(PP)**?-QP 

I F C F ) 4 6 ' 4 7 * 4 7 

CASE  of  ipagi^ary  ROOiS. 

46  U(NC+1 )=-HP 
U( NC  ) = -PP 

V ( NC  + 1 ) = SURT(-F  ) 

V(NC  )*-V(MC  + l) 

Go  TO  4 H 

CASE  OF  HEAL  ROOTS 

47  IKNC  + l ) = -STGN(  AnS ( PP  ) 4 SQR T f F ),PP) 

V(NC  + 1 > = 0. 

U ( NC  ) = QP/IJ  C NC  ♦ 1 ) 

VCNC)=0. 

FORP  NEW  RFniJCEo  COEFF  I C I F V T S 
4 ft  no  49  T - 1 ,NC 


noou6fl«t 
000068^0 
0 0 0 0 6 e 6 0 

000u6«70 
000O68M0 
00006890 
00006900 
OOOU69 10 
000O692O 
000069  JO 
000 06940 
000069bO 
0000696O 

000o69  7 0 
C0OO6980 
000O6990 
00OU700O 
00007010 
00007C20 
00OU7030 
00007040 
OOOU/ObO 
0000  7C60 
000O70/U 
000U708O 
00007090 
00007100 
000071 10 
000O7120 
0 0 0 0 7 1 30 
00007140 
00007150 
00007160 
000071 70 
OOOO  7 1 80 
00007190 
00007200 
00007210 


C-22 


09  H(I)=B(I+2) 
60  TO  7 
50  RETURN 
END 


00007220 

00007230 

00007240 

00007250 


APPENDIX  D 


TIME  HISTORY  PLOT  DIAGRAM  CARD  LIST 


D-l 


(Reverse  Page  D-2  Blank) 


D-3 


%CARr»  FKEFFORM 

FIlF  1 = T I m F P | T/nArA»nMlTxDlSK.SAvF  = 30»l  PCK#Rl.  nCKlNG  = .T,KECnRD-lo 
FILF  ?=0/H»l)N  IT*RFmOtF  * LOCK  > HECnRn=9 
FILL  3sPR | ASP»  UNI T=Po I NTER.rtFCn&n* 1 5 

FILF  A=FnRP/nSK,||MlT  = DISK,bAVE  = V).l  0(;k,  A HE  A = *5  000  » Rt  C OKO  = 30 
FILF  5 = APFR/0AT  A,UNIt*PISK, SAVF=in.LUCK ,«LUCK ING=1»HFCLRC=1 0 
REAL  NT, 

DIMENSION  XI  AREl  C 2 ) # Yl  AREl  ( 1)  . COM  RL  ( B ) » T I I LF  ( 11  ) 

DIMENSION  N G ( 1 A T . DGC  In  ) , Rfin  T R M A ) . ROO  T I(  1 A > ,{)LTPU  I C 1 00?  > • I(  10C?)» 

- FnRr.F.f^'2)»NC(5)*Mrlb)*7ERURno)»7LRnmO) 

COMMON  TOLL  »TMAy 

DATA  FnRCF/"IMPn","STtP”*"RAMp","P()l.  S*,,"RAMP«,"siNlJ"*"L<;F,,» 

. ,"STEPM.MSOinT’/ 

OATA(XLAPtLCI  )»T  = 1*2)/1?HTTmE-(SEC)  / 

OATAfYLAPELCl)*T=l»3)/18Hnl,TPliT-RFSpONSr  / 

C-  * * * * T ImEPLT  / M||MP*4  SOURCE  Is  T I mFPL  T /SORSF  Dk.  1) . F . MLMRHrFYS 
ITF=0  i KK=-i 

C-  99  FORMAT! //,"******  NOW, R||K  TwE  PROGRAM  PLIJ  T /HUMP  * * * * * " i 

ion  format ( hf i o . j ) 

105  FORMAT ( AF?0  . A) 

106  F0RMAT(5FlS. 3> 

REAOfWAOOO)  ( Tt  TLE(  I ) » 1 = 1 * 1 n 

aooo  format < 1 1 a*) 

RE  AO  C 1 * / )TF»T0FL»TMAX»RTJMF»PT1ME»W*IPLUTMWH1TE 
1 RFAnf  l»/»ENns3)TNGMl,f,AlN 
IF  ( I Ngw  1 • (» T . 0 ) G 0 TO  2 
Z t H 0 R ( 1 ) = *1  . • GO  To  ?is 

2 RE  ADn  » / ) ( 7FR0R  ( I ),ZEROi  ( n , 1st  , iNr.Mi  ) 

215  Rf  ADC  1 #/l  IDfiMI 

READ f 1 , /) (ROOTHf I ) , ROOT  1 ( IT , I = 1 , I PGM  1 ) 

IF  C I NG M 1 .GT. I )G0  TO  ?1? 

Nf.(  1 ) = -/E  HHRC  1 ) 

NG(2)=INGM1 x J . 

JNG=INGM1  + 1 

GO  TO  A 

21?  CALL  CPmPYCZEROP  . ZEROI  » INC.mi  ,mG,  ING  ) 

A CONTINUE 

c - 


OUOkOCUG 
0 0 0 U 0 0 1 L 
00()u002C 
000u003c 
00UO00 AG 
000U005G 
OOOGOO&G 
OOOuOCZC 
OOOuO C6G 
0000009c 
OOUUC 1 GO 
OOOuOl 1 G 
OOOuO 1 2G 
OOOuO  1 JC 
OOl)  u 0 1 A c 
OOOuO 1 bu 
OOOOC  1 OG 

ooouc  i n 

OCOOO  1 tit 
OOOUO 1 9G 
0 0 0 0 0 2 0 G 
000002  1G 
0000022U 

0000022c 
0000023c 
000U02 Ac 
000o02bC 
000U026C 
OOOUO?  7G 
0000020G 
0GCOC29C 
OOOuO  30c 

000O031C 
OOOOC  320 

OOOUO33G 
0C0O03AG 
OCOO035C 
OOOoO  36C 


oooooooo 


C" 

c- 


107 


JN 


kk*kk+ l 
ITF*lTr  ♦ 1 
FORMAT! 1 H 1 ) 
AMP*G A I N 

IF  - FORi 


IF 


CALL 


208 

98 

70 

101 

210 

82 

209 

216 

102 

80 

103 

104 


NG 

FUNCTION 

T 

NDlr ATOR 

*0 

IMPLIES 

AN 

IMPULSE 

*1 

implies 

A 

STEP 

*2 

IMPLIES 

A 

RAMP 

= 3 

IMPLIES 

A 

PULsE 

*4 

IMPLIES 

A 

RAMpSTEP 

*5 

implies 

A 

sinusoid 

MEf 

IF,  AMp,PTT 

mf,rtime,w 

ROOTI , IDGM 

1 ,IcODE) 

TF 

" ** 

**  *T I ME 

RF 

SPOnSE  run 

NUMBER"* 13,"  ***** «) 
*lOX*"THE  COEFFICIENTS  QF  THE  nUmfRATQR"/} 


1 * F 1 7 • 7 ) 

WRlTEC3»?10) 
tHE  NUMERATOR"/) 


OF 


FORMAT!/, IX, 

WRITE(3,90) 

F0RMAT(  / 

00  70  1*1, TNG 
WRITE(3M01  )I,Ng!  I) 

FORMAT! 10X,"NG!«, II,") 

IFCINGMi ,EQ.O)GO  TO  216  1 
FORMAT(////10X,"THE  ZEROS 
00  8?  I»1,INGM1 

WRITE! 3,209)1 ,ZfR0R( I ),ZEROT( T ) 

FORMAT ( lOX,"ZFRn(",  II,")*", FI  7. 7," 

WRITE(3,10?) 

F0RMAT(////10X,"THE  ROOTS  of  the  DENOMINATOR"/) 

DO  80  I*1MDGM1 

WRITE!  3,1  03)1, RnOTRU), ROOT? ! T) 

FORMAT! 10X,"R00t<", 11,”)*",  F 1 7 • 7 , " ♦ J ",F17.7) 
WRITE(3,104)  IF, ! FORCE! IF* 1 , 1 I, 1*1 ,2), AMP 

format(////ix,  "The  forcing  function  inoicatoh  iif)  = 
" this  implies  that  a ",2a4,"  input  was  used.",/, 
" AMPL  ITUDEa", F 1 7 . 7, // ) 

IF(IF.E0»3)  WRITE(3#205)  PTtMf 


♦ J ",F 17.7) 


",  13,/, 


00000370 
00000380 
00000390 
00000400 
00000410 
00000420 
00000430 
00000440 
00000450 
00000460 
000004ZQ 
00000480 
00000490 
00000500 
00000510 
00000520 
00000530 
00000540 
00000550 
00000560 
00000570 
00000580 
00000590 
00000600 
0C0O06 lo 
00000620 
000  (J  0630 
00000640 
00000650 
000  0660 
000u0670 
OOC 00680 
00000690 
00000700 
00000710 
00000720 
00000730 
000O0740 
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A 


20s  fhrmatt  /?nx.MPT?MEs",Fi 7.7) 
ifuf.eg.a)  wRurn#?o(n  HTtMr 

?0A  FORMAT  ( /?OX»"KtIM£  WAS  An.lHStFl)  Tn  ”#F10.A,"  SFCUNDS.”) 

IF  ( IF.  Ft),  b)  w R I T F ( 3 , ? o 6 ) w 
206  F(1RMAT(/  ?nx  . "FHf  QlJtNC  Y=",F1  7 * 7 ) 

IF  CICOnF  .F’Q.n)  (iu  T P 30  ? J W«  I tF  ( 3 # 06  > T CODt 
96  FORMA  T ( //  , " I r 13 1)  E =”#110) 

IF (ICnHF.FQ.l  ) wRITE(J,?Ol  ) 

?01  FORMAT  (//10X»”TMF  CCIMPlFX  PART  OF  THE  OUTPUT  VECTOR  UFCftME”# 
- "SIGNIFICANT”) 

IF(IC00F.FO.?)WPITF(3,20?) 

20?  FORMAT C // 1 Ox » ”MuLT  IPL L ROOTS  r NC UlIN I F NF 0"  ) 

IFC IC0DF.LR.3)  ww  I TE  ( .3  • 20  3 ) 

203  FORMAT  (//  1 nx  , "Bad  £MkY  - CHFrK  P t • t.  V N U M I A L ORUFRS  of  T . r . " ) 
IF  ( ICCOF  .NF  .0)  GIJ  TO  1 
302  XmaX  = T( i ) 

XMlN  = T( 1 ) 

YMax  = 0(ITpUT  C 1 ) 

YMIN  = niJTPUT(  1 ) 

FL£NuM=TMAX/Tn£l 
I IMsFLFM'm  + i ,n 
no  600  K I = 1 » I I H 
IF(T(Kl).LT.XMlN)XMIN=r(KT) 

IF(TfKl).GT.XMAy)XMAXsTfKT) 

IF(rUTPUT( K I ) .GT. YMAX  )YMax  = oUtPUI (K  1 ) 
IF(OUTpl)T(KT).LT.YMlN)YMlN  = nUTPUTfKl) 

600  continuf 

WR I TF( 3 »97  ) 

97  FORM AT(lHl»////,HX#"TlMf",1^x." OUTPUT”*/) 
on  io  i=i,io»? 

io  writfc3*?oo)tc n#ouTpuT( n 

200  F0RMATC2F 1 7. 7 ) 
wRlTF( 3# 107) 

I F ( 1WRITF  . £ 0 . 0 ) r,  0 T ()  ) 1 
ITER=1 

WRIT£(5»?1 3) 

WRITF(5,?14)IT£P.TMAX,IdGm1,ItH 
213  FORMAT (3 OX) 


OOUuO  750 
000u0760 
000U07  7 0 
00000780 
000uG79o 
00UU0800 
OOOoOfl  1 0 
000U082C 
000U0830 
000008AO 
00UO085O 
00000860 
oqouOs  7u 
00000880 
00UU0890 
00000900 
00000910 
00000920 
000O09  3o 
000O09 AC 
00000950 
0000099C 
000 0 0970 
00000980 
00000990 
OOOulOOo 
00001010 
00001020 
0000103c 
OOOUlOAo 
00001050 
000O106C 
000ol07o 
00001080 
0000109C 

00001  too 
OOOol 1 10 
000011 20 


o o o 


0 

1 

O' 


214  FORMAT(l5,F10.l#2l5) 

C“ 

12  WRITFC 5# 207 )( OUTPUT C I ), I si  , TOl 
207  F0RMAT(5(E.1?,5#lX)) 

11  continue 

IF( IPL0T.EQ.0)Gn  TO  1 
DX*(XMAX-XMlN)/7.  J 0Y*(YmaX-yMIN)/5. 

IF(ABS(OY).GT. .O0001 )G0T0TTA  » WRITE<3,301>  1 GOTOl 
334  IF<KK.GT.0)G0  TO  700 

CALL  PL0T(0#-l2,-3)  } CALL  PL0T(1>l»-3)  } GO  TO  800 

700  CALL  PL0T(i2»0»-3) 

800  continue 

301  format (///#"  ******no  plot  for  last  output******  "> 

A = 0.  y IFCYMIN.I  T.  0.. AND. YM T N + DYxs. GT. o. )A  = -YM IN/D Y 
CALL  AXlS(0»A>X|  ABEL » - l 1 » 7 » 0» *M I N, OX ) 

CALL  AXiS(0»0»Yl  AREL m 5» 5* 00* YH I N, D Y ) 

CALL  LINE(T#0UTPUT*IIH»l#O»3#yMlN,DX#YMlN»DY) 

GO  TO  t 

3 CONTINUE  y IFf  IPL0T.EQ.O>f,0  TO  ? 1 7 
CALL  PL0T(O,0»9q9> 

LOCK  4 

C-  WRITE(2,1071  )C-  WRTTF(9,99) 

217  STOP 
END 

subroutine  cpval(Res»aRg*x»tdtmx> 

COMPLEX  RES*ARG 
dimension  X ( 20 ) 

RES*( 0 , # 0 , ) 

J* I D I MX 

1 IF(J)3>3*2 

2 RES*RES*ARG+X( J> 

J*J-1 

GO  TO  1 

3 Return 
END 


00001130 
00001140 
0000H50 
00001160 
00001170 
00001180 
00001190 
00001200 
00001210 
00001220 
00001230 
00001240 
00001250 
00001260 
OOOOl 27C 
0000 1^60 

0000  l 7 VC 
GOOO 1 30C 

00001  3 1 0 
0000  1320 
OOOOl  33C 
00001340 
00001350 
00001360 
00001370 
OOC  :380 
0001  390 
OOOi  qOO 
000!  : 1 U 

00 00  < 20 

0000 1 a 30 
000U1440 
00001450 
000 0 I 460 
OOOi.  i 4 70 


QOGu 1 a90 


PURPOSE" 


OOOo 1500 


non  ononoooonoooonoo 


i 

-vi 


c- 

c- 

c- 

c- 

c- 

c- 

c- 

c- 

C" 

c- 

c- 

c- 

c- 

c- 

c- 

C“ 

c- 

c- 

c- 


THF  pilKPnsr  nF  THK  S'JH  Wf'UT  T N6  IS  TG  OtTERMlNE  T •-  fc.  T T m f 

rfsponsf  nr  i n p t r rn  a transfer  f u ^ c t i n ^ py  taking  ThF 
inversf  laplace;  transform  by  fHF  mfthou  cf  residues. 

INTRODUCTION  TG  AUTOMATIC  rONlRnt  SYSTEMS  - ROBERT  N.  CLANK 
(PR  70  - 77). 


VARIABLES" 

AMP  - AMPLITUDE  (IF  THF  FPRrlNG  FUNCTION 
PTTMF  - PUL  Sr  T I MF  (SPFriFiFU  F FIR  I F = 3 ) 

RTIMF  * R A UP  T I Mf  (SPECIF  iFn  FOR  I f = fl  ) 

H - FREQUFMCv  OF  ThE  SIMliSnIDAL  INPUT  (SPFCIFIEO  FOR  T F = 5 J 
Oil T pU T - v/FCtOH  of  CAlciii  AtF.D  HFSpOnCF  AMPLITUDE  VALiiES 
T - VFCTOR  Or  SECHHNTlAl  Ttme  VALUES  OIREcTlY  RELATtn  IQ  COTPl 
TO  - NUMBER  nF  OUTPUT  vAluFS  (CALCULATED) 

nc,  - vector  nF  numerator  c def  f i c i e n t s 

TnC  - OlMENSTON  of  the  *■'  ii  m r r a tor  coefficients 

ROOTR  - VECinT  Of  hFAL  PARTS  OF  THE  ROUTS 
ROOTI  - VFOfoR  OF  IMAOTmaKv  PARTS  OF  THE  ROOTS 
IllGMi  - NljMRrP  Of  hOOTs  (OHOt*  OF  the  DENOMINATOR) 

ICOOE  - RETURN  CODE  VARIARiE 

]Cnnr*o  IMPLIES  NORMAL  execution 

TCOOr=1  IMPLIES  that  ThF  COMPLEX  PART  OF  ThE  OUIPUI 

V F C T n R pFCaME  significant. 


TC0nF  = 3 I MPI.  t FS  that  THF  OR()FR  Of  THF  OENOmJnaIUR  wAS 
NOT  GRFATER  than  ThF  ORDER  OF  THE  NUMERATOR. 
IC00r=A  IMPLIES  THAT  THF  FURCTNG  FUNCTION  INDICATOR 
HAS  SPECIFIED  INCORRECTLY 


SOHROUT INES  C Al LEO” 

CPVA|  - COMP)  EX  EVALUATION  OF  A POLYNOMlAl 
TYMF  - RFSpOMSF  BY  THE  MpfwOu  nr  RLSIOULS 


0 0 0 ti  t b 1 C 
0 0 0 U 1 b 2 L 
OOOU 1 5 JO 
OGOU 1 bRC 
00001550 
GOUUlbftC 
0 0 0 0 t 5 7 u 
OOOulbdC 
000O15VU 
000O  1 60m 

0 0 0 0 1 6 1 C 
000O1620 
OOOul 6 3u 
000ul6au 

100001650 
000 0 1660 
OOOU 1 6 70 
00001660 
000016VC 
OOOUl  700 
0000171U 
OOOul 72 0 
OOOUl 730 
OCOu  l MU 
00001 750 
00001 700 
OOOul 77 0 
OOOUl 78t 
0000 1 7V0 

000 U 1800 

ooouia  io 
OOOUlfi^O 

0000 1 d 3u 
000U18AU 
00001850 
00001860 
00001870 

o o o o i e a o 


onr>  ort  no  oo  • i o oo  oooooooooo 


00001690 

REMARKS”  00001900 

00001910 

THIS  SUBROUTINE  IS  DESIGNED  TO  GENERATE  THE  TIME  RESPONSE  OF  A 00001920 
GENERAL  OUTPUT  FUNCTION  X0(S)  * Xl(S)G<S).  IN  THIS  00001930 

EVALUATION  Two  IMPORTANT  ASSUMPTIONS  ARE  MADE.  00001940 

1)  the  ORDER  of  THE  DENOMINATOR  OF  THE  OUTPllT  FUNCT J0N00001950 

of  the  Output  function.  00001960 

MUST  BE  LARGFR  than  the  ORDER  OF  THE  NUMfRATOR  00001970 

?)  MULTIPLE  ROOTS  OF  the  DENOMINATOR  MAy  NOT  EXIST.  00001980 

00001990 


********************************** 


SUBROUTINE  TIMEf I F , AMP. PT T ME , 

ROOTI.IDGMi ,1 

REAL  NG 

DIMENSION  P(14),NG(14),K<1A), 
R00TRM4  J/ROOTl  n a) 
COMMON  TOEL.TMAy 
ICQDE*4 

if(If.gt.5.or. If.lt.ojreturn 

GAIN0G*1 ./AMP 

determine  tmax 


*************************************00002000 

00002010 

RTIME»W»0UTPUT,T*I0,NG,ING,R00TR»  00002020 

r00E)  00002030 

OOOU20AC 

nUT( 1002 ),T( 100? ),OUTPUT( 1002),  00002050 

.SAVEdOO?)  00002060 

00002070 

00002080 

00002090 

00002100 

00002110 

00002120 

00002130 


$MALL*1 .Eft 
00  9 I*1#IDGM1 

ABSR»A8Sf ROOTRC I )) 

IF  (ABSR.E0.0l)  GO  TO  10 
IF(ABSR.LT. SMALL)  SMALL*ARSR 

IFC  IF.EO.OJGO  Tn  11 

GO  TO  C 10, ?0, 30,40,50)  .IF 

11  CALL  TYNE (OUTPUT, T.10.NG, T NG » ROOTR , ROO T I , IDGM1.GA I NOG, I CODE ) 

return 

10  IDGM1 =IDGM1*1 
ROOTR( IDGMl ) 3 0 • 

ROOTK  IOGMi  ) = o. 


00002140 
00002150 
00002160 
000021(0 
000o?l 00 
000O21V0 
00002200 
00002210 
000U222w 
00002230 
000 02240 
0 0 0 0 2 2 5 C 
000 0 2260 


D-9 


CAI  t TYMECmiTPlJT*  T , IC,NG  . 1 M'.*  ROU  TR  ,ROUTI  , 1UGM1  .r,A  INCG,  IrflL'L  ) 
" t T U ^ ^ 

?n  I pgm i = inr.Mi  + 1 

R (j  0 T R ( ! 0 G M 1 )=.On1 
Rom  \ c iogmi  )=o. 

IDGM1 = IoGmi + 1 
M 1 1 U T R ( I II G m i ) = -.nm 
ROOT  I ( 1 1)  G m 1 ) =0  , 

CALI.  T YMt  (nurPllT»T»  IO.NG*  T^f..RnOTR,HnOTI  , IOGMI  ,r,AiM3G,  IrODL  ) 
Rf TURN 

10  IOGMI = IOG*i +1 

ROOTRC inGMl  ) = 0 . n 
ROD T I ( ID G m 1 ) = o . n 

CALI  TYMF'C  SAVF  »t  » I Q » N u * TNG»RnnTR»RnQT  I * T D G M 1 • G A I N 0 G » TCOflF  ) 
irClCOOF.NF.O)  r,0  TU  1*4 
MT  IRF  = PT  I HF/TOLI  4-0,5 
IFCMTIMf  .LO.O)  r,0  TCJ  1? 

DO  11  Is1,htimE 

31  OUTPUT ( j )*SAVF( t ) 

32  TPIsMT  ImF.4-1 

DO  33  I=IPl» 10 

31  OUTPUT  ( I)s«iAVF(  T )-SAVf.  ( I -MT  IMF) 

34  RETURN 

GO  I=RTIME/TUEt  4-. 5 
«T  lRf  = I*TOFL 
IDGMl=IDGMi +1 
RUOTR ( I DGm 1 ) = , On  1 
ROOT  T ( I D G M 1 ) = 0.n 

I OGm 1 = I DGm 1 ♦ j 
ROOTH ( IOGMI )=- ,noi 
ROOT  I ( InGMl ) = 0 • 0 

gaikdg*gaiuog*Rttme 

CALI  TYMF(SAVF#T»in»N'(;»|NG,ROnTR.RnOTl,II)GPl,(iATNUG*TCOnE) 

IFCICODE.NF.O)  r.O  TO  nn 

MTfMF  = RTTMF/TnEl  4-0,5 

IFCMTIMF. £0.0)  GO  TO  <i2 

no  41  1=1 

«1  OUTPIITC  I )*5AVFC  T ) 


00002?  /O 
00002260 
000O22  vv, 
000u2300 
000u23  10 
00C0232O 
000 o 2330 
000^2340 
000U2  3bo 
OOOU23<:0 
000 U23/o 
000 02360 
000  (4  2390 
000O240G 
000o24 lo 
0 0 0 0 2 4 2 0 
000 02430 
OOOU2440 
000G24bo 
0 0002  4 6 0' 
OOOU24/0 
00OU246O 
000 02490 
0000250  O’ 
00002510 
000O252C 
000U2530 
00002540 
00002550 
000o2560 
000025/0 
000025HO 
000025V0 
00002600 
000O26  1 0 
0O0O262O 
00002630 
0004)2640 


42 

43 

44 
50 


c- 


? 

h-* 


c- 

c- 

c- 


c- 
c • 
c* 


IP1«HTIME«M 
00  43  I»IPl#I0 

OUTPUT(I>*SAVE(T>"SAVE(I"MTTMF> 

RETURN 

iogmi*idgmi+i 


R00TR( IDGM1 >*0. 

rooth  idGmi  )*W 

I DGM 1 ■ I ogm l ♦ 1 
ROOTR( IOGMt >*0. 
ROOTI(IOGMl)a-H 
CALL  TYME(OUTPUT,T, 


io,ngmng,rootr,rooti. 


IOGMWGAINOG,ICODE) 


return 

DEBUG  SUBCHK 


00002650 

00002660 

00002670 

00002680 

00002690 

00002700 

00002710 

00002720 

00002730 

00002740 

00002750 

00002760 

00002770 

00002780 


SUBROUTINE  TYMErOUTPUT.T.tn.Ne.INO.ROOTH.ROOTl.lOGNl.GMNOB.ICOOE 
COMPLEX  P,S*0||T,0UT1*K*KJ.KnUM 

OIhInSiON  P(l*)»NG(10»K<1*)»nUT(1002 )# OUTPUT C 1 002)#T(l002>f 
R00TRfl4>*R00TI(14>.TTEST(16> 

COMMON  TOELrTMAX 

CHECK  FOR  BAO  ENTRY 

IF< lOGMl ,Lt. INGI  GO  TO  55 

CHECK  FOR  MULTIPLE  ROOTS 

DO  5 1*1*1  OGM I 

RRP1*R00TR( I J+.OOOl 
RRM1*R00TR( I )- .0001 
R iPl "ROOT  I ( I >4.0001 

RIMl*R00Tl(I);.O00l 

00  5 J*  1 » I0GM1 
IFCI.EQ.J)  GO  Tn  5 
RRJ*ROOTR( J) 

RIJ*R00TI(J>  , • „ _M(, 

Ip(RRMl  .LT.RRJ*  ANDrRRRI -GT*RR.l»ANO 

GO  TO  50 


.RlMl.LT»RIJ»AND»RlPl*GT*HlJ) 


>00002790 

00002800 

00002810 

00002820 

00002630 

00002840 

00002850 

00002860 

00002870 

00002880 

00002890 

00002900 

00002910 

00002920 

00002930 

00002940 

00002950 

00002960 

00002970 

00002980 

00002990 

0000300C 

00003010 

00003020 


GO  Tn  5 

so  ruoth( j ) = K(in r r ( n - n.ono? 
cunt  i mif 
ir.onr=u 

on  11  isi,tdg*i 

11  p ( I )=CMTL*f  RfinT^(  I ),RuUT  If  n ) 

nrTFRMINF  Tht  K”S 

DO  15  J*1MI)GM1 
5=P( J) 

CALL  CPvAL(KN||M,  s#Nq.  iNg) 

K J = ( 1 . ,0.  ) 

00  25  L = 1 , I 0GM  1 
IF(L.EQ.J)  GO  Tn  ?5 
K J = K J/(S"P(L  > > 

?5  CONTINUE 

K(J)=KJ*KMJM/GATN0G 
15  CONTINUE 

DETERMINE  THr  TIME  ResPHNSt 
10  = 0 

T 1 =*  T DEL 

3 A 10*10+1 

OUT  1 * ( 0 . * 0 • ) 

T1=T1+T0El 
on  35  J*1M0GM1 

IF (ROOTR( J)*T1  .1  T.-100.)  GO  Tn  35 
0UT1=0UT  l+*<(J)*CEXP(Tl*P(Jn 
35  CONTINUE 

OUTPUT ( 1 0 ) = R E A L f 0 1 1 T 1 > 

UNREAL  = AlKAC.(nUTl  ) 

IF( ABS(UNHEAl)  .1  T. .01)00  TO  1 nO 
WRITE( 3» 101  ) 00  T 1 
101  FORMAT(?F?0.n 

100  continue 

T ( I C ) * T 1 


0 0 0 u 3 C J 0 
0U0o3CAu 
000o30b0 
0000  3060 
000030/0 
000030HC 
000U309O 
00UU310U 
000031 10 
000U3120 
000o3li0 
000031  AC 
00003150 
00003160 
000031 /C 
00003180 
00003190 
00003200 
00OO321C 
000o3?2U 
00003? JO 
0000  32  AO 
00003250 
00003260 
000032/0 
0000 3260 
0000  3290 
0000330O 
000O33 10 
000O332O 
OOO0333G 

OOOu  3 3 AO 
000U3350 
00 003360 
000O33/0 
00003380 
0C003390 
000O3A0O 
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i r c t i .lt.tmaxj  r.o  to  34  00003410 

IF(ABS(UNREAL).C,T.  ,0l)WRITFr3.l02)  00003420 

102  format ( 1 hi  ) 00003430 

RETURN  00003440 

55  ICoOE»3  00003450 

RETURN  00003460 

C-  DEBUG  SUBCHK  00003470 

ENO  00003480 

SUBROUTINE  PLOTfX, Y,IPEN)  00003490 

0 1 MENS  I ON  CONT(O)  00003500 


OATA  C0NT/5lHCCrX  PL0t/HUMP*577 35 1 002 1 F I LE  F T LER AY*F0RP/DSK t END  . / 00003510 


C-  00003520 

BCD  a ( 6M  P)  00003530 

WRlTE(4)8C0#X,Y#IPENJlF(lpFN.NE.999)RETURNJLnCK  4 00003540 

CALL  ZlP(CONT) JRETURN  00003550 

END  00003560 

SUBROUTINE  SYMBOL ( X* Y, SZ» BCD# ANG* NC ) 00003570 

DIMENSION  BCD ( 1 3 ) 00003580 

T»(6h  S)  00003590 

NWi*6  00003600 

IF(MOD(NC#A)  ,EO.O)NWlaO  00003610 

NW  *( IABS(NC)+  NW 1 )/6  00003620 

WRlTE(4)T#X#Y#S7*ANG»NC*(RCn(T)M*1'NN)  00003630 

RETURN  00003640 

END  00003650 

SUBROUTINE  AX  I S ( X# Y> BCO, NC » AXl  EN > ANG; RM I N# DEI  TV  ) 00003660 

DIMENSION  BCO( 1 3 ) 00003670 

T ■(6H  A)  00003680 


NW1»6  00003690 
IF(MOD(NC*6).EO.O)NWlsO  00003700 
NW  a(IABSCNC)  ♦ NW1J/6  00003710 
WRITE(4)T#X»Y»Nr»AXLEN»ANG»RMTN#DELTV#{BCD(I)>Isl»NW)  00003720 
RETURN  00003730 
END  00003740 
SUBROUTINE  L I NE ( PX, PY, NPT,  T NC . L T YP, I SM, F I R STX > DFL TX* F I R <T Y * DELT Y ) 000037  50 
0 1 Mf Ns  I ON  Px(NPT)#PY(NPt),RCDM ) 00003760 
INTEGER  A#TEMP,p,C  00003770 
S =(6H  S>  00003780 
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P = (6H  P) 

SZ  s.O P 

ANG  -0.0  > I*  =1 

?0  AM 

R =1  APSf  IlvC  ) 

C = NPT 
NA  z 0 

IC  = 3 
IS  =-  1 
ICA  = 2 
ISA  =-? 

NT  = 1 

IF  (I  TYP)  3(),ao,5n 
.30  ISA  = “1 

8 =R  *LTYP  MSA 
GO  TO  60 
/JO  NT  = - 1 
GO  TO  60 

50  NT  sLT  Yp  ;\a  = -1  4-M  r 

60  IF( ISM*3)8Cn( l )s(6H+OOO0O) 

IFCISM=1  ) H C [)  ( 1 )=(  6HOO<  000  ) 

00  100  I=A,C»H 
XPT  =(PX(I)  -FIRSTXJ/uFLTX 
YPT  =(PY(I)  -FIPSTYJ/uCLTy 
NA  sNA+1 

if(na=m)go  to  mo 
WRItE(A)P>XPT>YpT»IC 
GO  TO  105 

110  WRITF(/J)SMPTMPT»SZ*ANGMY.HrO(1  ) 

N A =0 

105  IC  =ICA 
IS  = I S A 
100  CONTinUf 
RETURN 
FNO 

SURROiiT  I NF  CPmPyC7FR(Jr.  ZERO  l M NGM1»  A»1  OIMZ  > 
COMPLFX  X # Y » 7 


0C'H;  3 790 
nuou3euo 
o o o o 3 a l o 

00003820 
OCOo  38  30 
00003890 
000u38b0 
0 0 0 0 3 fl  6 0 
OCOu  38  7o 
00003880 
00UO38SIC 
000O390O 
0U0O39 10 
00003920 
00003930 
0000  3990 
0 0 0 u 3 9 b 0 
000039oo 
0C00397O 
00003980 
00003990 
000O90OO 

ooooao lo 

000O9O20 
00009030 
000  0 9090 
000090b0 
00009060 
00009070 
000U9080 
00OU909O 

000  J) 9 l Ov/ 
000091 1 0 
00009120 
0C0u9 1 3u 
000U9 1 90 
000O9 1 bO 
00009160 
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01  MENS  I ON  XC28 )#Y(?B) ,Z(28>#ZER0Rf2« )# ZERO  1(28) #A(?8) 

00  11  1*1 » 1NGM1 

11  ZERORC I )*-ZERORr I ) 

X(l)*CMPtX(ZEROR(l)#ZEROIf 1 )) 

X(2)*( 1 • #0 • ) 

I0IMX«2 

Y( 2 )*( 1 .#0.  ) 

I0IHY-2 

MAX00*INGM1  - 1 
DO  1 fO.wMAXOO 
J»IO  + 1 

Y(1)«CMPLX(ZER0R(J)#ZER0I( J>> 

I0IMZ*IDIMX  + IniMY  - 1 

DO  SO  Il>l»!DlMZ 
30  Z( II >*<0.'0.  > 

00  40  I2*1*I0IMX 
00  AO  JlMMDlMz 
K*l2  + Jl  - 1 

40  Z(K)*X( I2)*Y( Jll  ♦ Z(K> 

DO  50  I 3*1 » IDIMZ 
50  X(I3)«Z(I3) 

1 ioimx-idimz 
00  60  IA*1»I0IMZ 

60  A(IA)*REAL(Z(IAD 
00  20  J*l# iNGMl 
20  ZEROR( J)*-ZERORf J) 

RETURN 

end 


00004170 

00004100 

00004190 

00004200 

00004210 

00004220 

00004230 

00004240 

00004250 

00004260 

00004270 

00004280 

00004290 

00004300 

00004310 

00004320 

00004330 

00004340 

00004350 

00004360 

00004370 

00004380 

00004390 

00004400 

00004410 

00004420 

00004430 

00004440 


Vr 
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